protected internal override bool ParseRecordResults(int receiveSize)
{
// Server commands (Query/Execute UDF) should only send back a return code.
// Keep parsing logic to empty socket buffer just in case server does
// send records back.
dataOffset = 0;
while (dataOffset < receiveSize)
{
ReadBytes(MSG_REMAINING_HEADER_SIZE);
int resultCode = dataBuffer[5];
if (resultCode != 0)
{
if (resultCode == ResultCode.KEY_NOT_FOUND_ERROR)
{
return(false);
}
throw new AerospikeException(resultCode);
}
byte info3 = dataBuffer[3];
// If this is the end marker of the response, do not proceed further
if ((info3 & Command.INFO3_LAST) == Command.INFO3_LAST)
{
return(false);
}
int fieldCount = ByteUtil.BytesToShort(dataBuffer, 18);
int opCount = ByteUtil.BytesToShort(dataBuffer, 20);
ParseKey(fieldCount);
for (int i = 0; i < opCount; i++)
{
ReadBytes(8);
int opSize = ByteUtil.BytesToInt(dataBuffer, 0);
byte nameSize = dataBuffer[7];
ReadBytes(nameSize);
int particleBytesSize = (int)(opSize - (4 + nameSize));
ReadBytes(particleBytesSize);
}
if (!valid)
{
throw new AerospikeException.QueryTerminated();
}
}
return(true);
}
public int?ReadInt32(String addr)
{
if (IsDoubleAddr(addr))
{
var recData = ReadAddr(ModbusFunCode.READ_REGISTER, 2, ConvertFatekAddrToModbusAddr(addr.Substring(1)));
return(ByteUtil.BytesToInt(recData[1], recData[2], recData[3], recData[4]));
}
else
{
ErrorMessage = "地址格式不正确";
return(null);
}
}
protected internal override void ParseRow(Key key)
{
// Server commands (Query/Execute UDF) should only send back a return code.
// Keep parsing logic to empty socket buffer just in case server does
// send records back.
for (int i = 0; i < opCount; i++)
{
int opSize = ByteUtil.BytesToInt(dataBuffer, dataOffset);
dataOffset += 7;
byte nameSize = dataBuffer[dataOffset++];
int particleBytesSize = (int)(opSize - (4 + nameSize));
dataOffset += nameSize + particleBytesSize;
}
if (!valid)
{
throw new AerospikeException.QueryTerminated();
}
}
public int[] ReadInt32(String addr, byte Count)
{
if (IsDoubleAddr(addr))
{
var recData = ReadAddr(ModbusFunCode.READ_REGISTER, 2 * 4, ConvertFatekAddrToModbusAddr(addr.Substring(1)));
if (recData != null)
{
var result = new int[Count];
for (byte b = 0; b < Count; b++)
{
result[b] = ByteUtil.BytesToInt(recData[4 * b + 1], recData[4 * b + 2], recData[4 * b + 3], recData[4 * b + 4]);
}
return(result);
}
return(null);
}
else
{
ErrorMessage = "地址格式不正确";
return(null);
}
}
unsafe public override void Can_Rec_Tick()
{
UInt32 res = new UInt32();
res = VCI_GetReceiveNum(DevType, DevIndex, CanIndex);
if (res == 0)
{
return;
}
/////////////////////////////////////
UInt32 con_maxlen = 100;
IntPtr pt = Marshal.AllocHGlobal(Marshal.SizeOf(typeof(VCI_CAN_OBJ)) * (Int32)con_maxlen);
res = VCI_Receive(DevType, DevIndex, CanIndex, pt, con_maxlen, 5);
////////////////////////////////////////////////////////
String str = "";
for (UInt32 i = 0; i < res; i++)
{
VCI_CAN_OBJ?reviceObj = null;
try
{
reviceObj = (VCI_CAN_OBJ)Marshal.PtrToStructure((IntPtr)(pt.ToInt64() + i * Marshal.SizeOf(typeof(VCI_CAN_OBJ))), typeof(VCI_CAN_OBJ));
}
catch (Exception ex)
{
Console.WriteLine(ex.Message);
}
if (!reviceObj.HasValue)
{
break;
}
var obj = reviceObj.Value;
var targetID = (byte)(obj.ID >> 3);
var mask = (byte)(obj.ID & 0b111);
Console.Write("rec: 0x{0:x4} ", obj.ID);
for (var j = 0; j < obj.DataLen; j++)
{
Console.Write("0x{0:x2} ", obj.Data[j]);
}
TimeSpan ts = DateTime.Now - new DateTime(1970, 1, 1, 0, 0, 0, 0);
Console.WriteLine("TimeStamp:" + Convert.ToInt64(ts.TotalSeconds).ToString());
if (targetID != (byte)(ID & (0xFF << 3 | mask)))
{
Console.WriteLine("ID不符，数据丢弃");
continue;
}
//Console.WriteLine("objlen=" + obj.DataLen);
str = "接收到数据: ";
str += " 设备ID:0x" + Convert.ToString(targetID, 16);
str += " ID掩码:0x" + Convert.ToString(mask, 16);
str += " 帧格式:";
if (obj.RemoteFlag == 0)
{
str += "数据帧 ";
}
else
{
str += "远程帧 ";
}
if (obj.ExternFlag == 0)
{
str += "标准帧 ";
}
else
{
str += "扩展帧 ";
}
//////////////////////////////////////////
if (obj.RemoteFlag == 0)
{
str += "数据: ";
byte len = (byte)(Math.Min(obj.DataLen % 50, 8));
byte[] data = new byte[len];
for (byte j = 0; j < len; j++)
{
data[j] = obj.Data[j];
str += " " + ByteUtil.ToHex(obj.Data[j]);
}
//bool is_mask = (data[0] & 0x07) == 0x07;
//data[0] = is_mask ? (byte)(data[0] >> 3) : data[0];
(String CanAddress, CanFunCodeEnum FunCode) = ParseCanData(data);
if (FunCode == CanFunCodeEnum.UPLOAD_COIL || FunCode == CanFunCodeEnum.UPLOAD_REGISTER || FunCode == CanFunCodeEnum.READ_COIL || FunCode == CanFunCodeEnum.READ_REGISTER || FunCode == CanFunCodeEnum.WRITE_SINGLE_COIL || FunCode == CanFunCodeEnum.WRITE_SINGLE_REGISTER)
{
lock (RecSafeData.Lock)
{
bool is_pass = true;
if (FunCode == CanFunCodeEnum.WRITE_SINGLE_COIL || FunCode == CanFunCodeEnum.WRITE_SINGLE_REGISTER)
{
is_pass = data[3] == 0xb0 || data[4] == 0xff || data[5] == 0xff;
}
if (is_pass == false)
{
ErrorSystem.WriteActError("通讯返回错误！", false);
}
if (is_pass)
{
string key_str = ByteUtil.ToHex(targetID) + ByteUtil.ToHex(data[0]) + ByteUtil.ToHex(data[1]) + ByteUtil.ToHex(data[2]) + ByteUtil.ToHex(data[3]);
if (!Rec_SafeData.ContainsKey(key_str))
{
Rec_SafeData.Add(key_str, true);
}
else
{
Rec_SafeData[key_str] = true;
}
if (ListenFunList.ContainsKey(key_str))
{
var task = Task.Run(() =>
{
ListenFunList[key_str](targetID, data);
});
}
}
}
}
switch (FunCode)
{
case CanFunCodeEnum.READ_COIL:
{
byte length = 1;
String canId = CanAddress.Split('-')[0];
UInt16 addr = ByteUtil.BytesToUInt16(data[2], data[3]);
for (byte k = 0; k < length; k++)
{
byte curData = data[k / 8 + 4];
String key = canId + "-" + Convert.ToString(addr + k, 16).PadLeft(4, '0').ToUpper();
//var val = ((0x01 << (k % 8)) & curData) == 0x01;
var val = data[4] == 0xff;
SetBool(key, val);
}
break;
}
case CanFunCodeEnum.UPLOAD_COIL:
{
byte length = data[4];
String canId = CanAddress.Split('-')[0];
UInt16 addr = ByteUtil.BytesToUInt16(data[2], data[3]);
for (byte k = 0; k < length; k++)
{
byte curData = data[k / 8 + 5];
String key = canId + "-" + Convert.ToString(addr + k, 16).PadLeft(4, '0').ToUpper();
var val = ((0x01 << (k % 8)) & curData) == 0x01;
SetBool(key, val);
}
break;
}
case CanFunCodeEnum.READ_REGISTER:
case CanFunCodeEnum.UPLOAD_REGISTER:
{
var val = ByteUtil.BytesToInt(data[4], data[5], data[6], data[7]);
SetInt(CanAddress, val);
break;
}
case CanFunCodeEnum.WRITE_MULTI_COIL:
{
break;
}
case CanFunCodeEnum.WRITE_SINGLE_COIL:
{
break;
}
case CanFunCodeEnum.WRITE_SINGLE_REGISTER:
{
break;
}
}
}
//Console.WriteLine(str);
}
Marshal.FreeHGlobal(pt);
}
