Refactorization : BenchControl -> Rig
This commit is contained in:
Milan Hanajik
@@ -0,0 +1,186 @@
|
||||
///
|
||||
/// Copyright (c) 2021 Sensus Slovensko a.s.
|
||||
///
|
||||
using System;
|
||||
using System.Diagnostics;
|
||||
using Dirichlet.Numerics;
|
||||
|
||||
namespace TBF.Rig.ControlBoard.Uni
|
||||
{
|
||||
public static class OutputMessage
|
||||
{
|
||||
public const int PayloadLen = 38;
|
||||
public const byte MessageCode = (byte)' ';
|
||||
|
||||
public static byte[] GetMessage(Action action, short config)
|
||||
{
|
||||
byte[] message = new byte[PayloadLen + 5]; /// headed 3 bytes, checksum 2 bytes
|
||||
|
||||
/// Header + message code (4 bytes)
|
||||
message[0] = Const.STX;
|
||||
message[1] = 1; /// Control board addres
|
||||
message[2] = (byte)PayloadLen; /// Payload length
|
||||
message[3] = MessageCode;
|
||||
|
||||
/// Command
|
||||
message[4] = GetCommand(action);
|
||||
message[5] = action.IsStart() ? GetStartParams(action) : action.IsStop() ? GetStopParams(action) : (byte)0;
|
||||
message[6] = (action.DivId <= 0) ? (byte)0 : (byte)(action.DivId - 1);
|
||||
|
||||
int totalPulsesCount = (action.TotalPulsesCount < 0) ? 0 : action.TotalPulsesCount;
|
||||
message[7] = (byte)(totalPulsesCount & 0xFF);
|
||||
message[8] = (byte)((totalPulsesCount >> 8) & 0xFF);
|
||||
message[9] = (byte)((totalPulsesCount >> 16) & 0xFF);
|
||||
|
||||
int massPulsesCount = (action.MassPulsesCount < 0) ? 0 : action.MassPulsesCount;
|
||||
message[10] = (byte)(massPulsesCount & 0xFF);
|
||||
message[11] = (byte)((massPulsesCount >> 8) & 0xFF);
|
||||
message[12] = (byte)((massPulsesCount >> 16) & 0xFF);
|
||||
|
||||
message[13] = 0;
|
||||
|
||||
message[14] = (byte)(config & 0xff);
|
||||
message[15] = (byte)((config >> 8) & 0xff);
|
||||
|
||||
/// Route
|
||||
message[16] = ((action.ActionId & ActionID.ChangeRoute) != 0) ? (byte)1 : (byte)0; /// Route change flag
|
||||
message[17] = (byte)(action.Route & 0xFF);
|
||||
message[18] = (byte)((action.Route >> 8) & 0xFF);
|
||||
message[19] = (byte)((action.Route >> 16) & 0xFF);
|
||||
message[20] = (byte)((action.Route >> 24) & 0xFF);
|
||||
message[21] = (byte)((action.Route >> 32) & 0xFF);
|
||||
message[22] = (byte)((action.Route >> 40) & 0xFF);
|
||||
message[23] = (byte)((action.Route >> 48) & 0xFF);
|
||||
message[24] = (byte)((action.Route >> 56) & 0xFF);
|
||||
|
||||
/// DA2
|
||||
message[25] = 0;
|
||||
message[26] = 0;
|
||||
|
||||
/// Regulation valve
|
||||
message[27] = (action.RegVId < 0) ? (byte)0 : (byte)(action.RegVId | (int)action.RegVMode);
|
||||
message[28] = (byte)(action.RVMovePar1 & 0xFF);
|
||||
message[29] = (byte)((action.RVMovePar1 >> 8) & 0xFF);
|
||||
message[30] = (byte)(action.RVMovePar2 & 0xFF);
|
||||
message[31] = (byte)((action.RVMovePar2 >> 8) & 0xFF);
|
||||
message[32] = action.IsStop() ? (byte)0x20 : action.IsStart() ? (byte)0x42 : (byte)0; /// ZStavReg
|
||||
|
||||
/// DA1
|
||||
message[33] = 0; /// PrudParL
|
||||
message[34] = 0; /// PrudParH
|
||||
|
||||
message[35] = (byte)Math.Max(1, Math.Min(255, action.PID)); /// PIDRV
|
||||
message[36] = (byte)Math.Max(4, Math.Min(255, action.TolerRV)); /// TolerRV (4..20 mA reg.valve only)
|
||||
message[37] = (byte)Math.Max(0, Math.Min(255, action.StabTime)); /// StabRV
|
||||
message[38] = (byte)((action.DivThreshold >> 2) & 0xFF); /// HranAK
|
||||
|
||||
message[39] = 0;
|
||||
message[40] = 0;
|
||||
Debug.Assert(40 == PayloadLen + 2);
|
||||
|
||||
/// Checksum (2 bytes)
|
||||
int checksum = 0;
|
||||
for (int i = 1; i < PayloadLen + 3; i++) checksum += message[i];
|
||||
message[PayloadLen + 3] = (byte)(checksum & 0xFF);
|
||||
message[PayloadLen + 4] = (byte)((checksum >> 8) & 0xFF);
|
||||
|
||||
return message;
|
||||
}
|
||||
|
||||
|
||||
static byte GetCommand(Action action)
|
||||
{
|
||||
int command = 0;
|
||||
if (action.IsStart()) command |= (int)Command.Start;
|
||||
if (action.IsStop()) command |= (int)Command.Stop;
|
||||
return (byte)command;
|
||||
}
|
||||
|
||||
static byte GetStartParams(Action action)
|
||||
{
|
||||
int param = action.FlowMId & (int)StartParam.EtalonMask;
|
||||
|
||||
if (action.IsDivUsed)
|
||||
param |= (int)StartParam.DiverterStart;
|
||||
|
||||
if (action.IsSyncMethod)
|
||||
param |= (int)StartParam.SynchroMethod;
|
||||
else
|
||||
param |= (int)StartParam.StartStopMethod;
|
||||
|
||||
return (byte)param;
|
||||
}
|
||||
|
||||
static byte GetStopParams(Action action)
|
||||
{
|
||||
int param = 0;
|
||||
return (byte)param;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
public enum Command : byte
|
||||
{
|
||||
RequestData = 0,
|
||||
Start = 1,
|
||||
Stop = 2,
|
||||
GetDiverterTransitionData = 4,
|
||||
GetScopeAnalyzerData = 7,
|
||||
ResetScopeAnalyzer = 8,
|
||||
GetSwitchCounterData = 9,
|
||||
}
|
||||
|
||||
public enum StartParam : byte
|
||||
{
|
||||
EtalonMask = 0x07,
|
||||
DiverterStart = 0x08,
|
||||
SynchroMethod = 0x10,
|
||||
DirectGateStart = 0x20, /// ???
|
||||
StartStopMethod = 0x40,
|
||||
CalibrationMode = 0x80,
|
||||
}
|
||||
|
||||
public enum StopDevs : byte
|
||||
{
|
||||
None = 0,
|
||||
Reference = 0x01, /// bit 0
|
||||
Diverter = 0x02, /// bit 1
|
||||
GatePulse = 0x08, /// bit 3
|
||||
TimeMeasurement = 0x10, /// bit 4
|
||||
BypassDevCoupled2Div = 0x20, /// bit 5
|
||||
RegValveRegulation = 0x80, /// bit 7
|
||||
All = 0xFF,
|
||||
}
|
||||
|
||||
public enum TestMethods
|
||||
{
|
||||
Diverter = 0x01, /// bit 0: 1=Mass method (diverters are used), 0=Volume method
|
||||
FixedStart = 0x02, /// bit 1: 1=fixed start method, 0=flying start method
|
||||
Synchro = 0x04, /// bit 2: 1=Synchro method, 0=Pulse counting
|
||||
MassAndContinue = 0x10, /// bit 4: 1=Method with mass measurement followed by a volume method
|
||||
}
|
||||
|
||||
public enum ValveChgFlag : byte
|
||||
{
|
||||
DoNotChange = 0,
|
||||
Change = 1,
|
||||
SendPressureMeterAddresses = 2,
|
||||
}
|
||||
|
||||
public enum RegValveMode : byte
|
||||
{
|
||||
None = 0,
|
||||
TargetFrequency = 0x10, /// Low and high frequency limits (0..2000Hz,0..2200Hz) are specified
|
||||
TargetPosition = 0x20, /// Low and high position (=DAC value) limits (0..100%) are specified
|
||||
Stop = 0x30, /// Stop regulation
|
||||
PulseWidth = 0x40, /// Pulse width 0.05 .. 2 sec. ... opening and closing (opening=0x40, closing=0xC0)
|
||||
NegPulseWidth = 0x80, /// Pulse width 0.05 .. 2 sec. ... closing (closing=0xC0)
|
||||
}
|
||||
|
||||
public enum RegValveState : byte
|
||||
{
|
||||
Idle = 0,
|
||||
PwOrFreqRegul = 2,
|
||||
DacValueRegul = 3,
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user