88 lines
3.4 KiB
C#
88 lines
3.4 KiB
C#
using System;
|
|
using System.IO;
|
|
using System.Linq;
|
|
using TBF.Rig.TestMethods.iPerlCommunication.communication.C4.diagnosticLed;
|
|
using TBF.Rig.TestMethods.iPerlCommunication.communication.C4.protocolCommons;
|
|
|
|
namespace TBF.Rig.TestMethods.iPerlCommunication.iPerlHead
|
|
{
|
|
internal class SimulationServices
|
|
{
|
|
const int Q2CorrFactorsAddr = 0x1878;
|
|
|
|
internal static int ReadRequest(TestMethodCfg cfg, IperlHead iperlHead, MessageID messageID, int offset, int length, out byte[] buffer)
|
|
{
|
|
|
|
|
|
string pcbStr = iperlHead.RfidComPortNr.ToString().PadRight(10,'0') + iperlHead.Position.ToString("D2");
|
|
long decVal = Convert.ToInt64(pcbStr);
|
|
string nHexStr = decVal.ToString("X4");
|
|
|
|
ConfigStruct configStruct = new ConfigStruct();
|
|
configStruct.PCBNumberString = nHexStr;
|
|
configStruct.StatusMode = ProtocolStatuses.Active;
|
|
configStruct.OpthoStatusMode = DiagnosticLedState.State4;
|
|
configStruct.Version = "Good Version: 123456";
|
|
|
|
byte[] configurationBuffer;
|
|
|
|
using (var ms = new MemoryStream())
|
|
using (var writer = new BinaryWriter(ms))
|
|
{
|
|
configStruct.WriteBinary(writer);
|
|
writer.Flush();
|
|
configurationBuffer = ms.ToArray(); // ← this is the binary output
|
|
}
|
|
|
|
byte[] calibrationBuffer = new byte[CalibrationStructV4.Length] { 3, 0, 150, 10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 2, 3, 4, 5, 0, 0, 150, 10 };
|
|
buffer = new byte[length];
|
|
|
|
return 0;//switch off
|
|
|
|
if (messageID == MessageID.Configuration)
|
|
{
|
|
Array.Copy(GetPCB(iperlHead), 0, configurationBuffer, 16, 5); // set PCB Number according to iPerlHead configuration
|
|
Array.Copy(configurationBuffer,offset,buffer,0,length);
|
|
}
|
|
else if (messageID == MessageID.Calibration)
|
|
{
|
|
Array.Copy(calibrationBuffer, offset, buffer, 0, length);
|
|
}
|
|
else if ((messageID == MessageID.MetrologyMemory) && (offset == Q2CorrFactorsAddr) && (length == 2))
|
|
{
|
|
buffer = new byte[2] { 0, 0 };
|
|
}
|
|
else
|
|
{
|
|
buffer = new byte[length];
|
|
}
|
|
|
|
return iperlHead.Name.Equals("iPerl13") ? 2 : 0; /// Simulates an error on position 13
|
|
}
|
|
|
|
internal static int WriteRequest(TestMethodCfg cfg, IperlHead iperlHead, MessageID messageID, int offset, int length, byte[] buffer)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
private static Array GetPCB(IperlHead iperlHead)
|
|
{
|
|
string pcbStr = iperlHead.RfidComPortNr.ToString().PadRight(10,'0') + iperlHead.Position.ToString("D2");
|
|
long decVal = Convert.ToInt64(pcbStr);
|
|
string nHexStr = decVal.ToString("X4");
|
|
|
|
string hexStr = "";
|
|
for (int a = nHexStr.Length; a >= 1; a = a - 2)
|
|
{
|
|
hexStr = hexStr + nHexStr.Substring(a - 2, 2);
|
|
}
|
|
|
|
return Enumerable.Range(0, hexStr.Length)
|
|
.Where(x => x % 2 == 0)
|
|
.Select(x => Convert.ToByte(hexStr.Substring(x, 2), 16))
|
|
.ToArray();
|
|
|
|
}
|
|
}
|
|
}
|