private uint Dequeue(out CAN_FRAME[] pCANFrames, uint length, ConcurrentQueue <CAN_FRAME> queue)
{
pCANFrames = new CAN_FRAME[length];
uint nRealNum = 0;
for (uint index = 0; index < length; index++)
{
CAN_FRAME pCANFrame;
if (queue.TryDequeue(out pCANFrame))
{
pCANFrames[nRealNum++] = pCANFrame;
}
}
pCANFrames = pCANFrames.Take((int)nRealNum).ToArray <CAN_FRAME>();
return(nRealNum);
}
/// <summary>
/// 接收CAN帧数据
/// </summary>
/// <param name="pCanFrames">接收到的帧数组</param>
/// <param name="length">需要接收的帧数</param>
/// <param name="waitMilliseconds">等待时间ms</param>
/// <returns>实际接收的帧数</returns>
private uint Receive(out CAN_FRAME[] pCanFrames, uint length, int waitMilliseconds)
{
uint realRcvNum = 0;
pCanFrames = null;
try
{
IntPtr pReceive = Marshal.AllocHGlobal(Marshal.SizeOf(typeof(CAN_OBJ)) * (Int32)length);
realRcvNum = CANDLL.Receive((uint)p_ParentDevice.DeviceType, p_ParentDevice.DeviceIndex, m_ChannelIndex, pReceive, length, waitMilliseconds);
if (realRcvNum != uint.MaxValue)
{
Logger.Info(string.Format("channel[{0}] receive [{1}/{2}] messages successful.", m_ChannelName, realRcvNum, length));
pCanFrames = new CAN_FRAME[realRcvNum];
for (int index = 0; index < realRcvNum; index++)
{
CAN_OBJ pCANObj = (CAN_OBJ)Marshal.PtrToStructure((IntPtr)((UInt32)pReceive + index * Marshal.SizeOf(typeof(CAN_OBJ))), typeof(CAN_OBJ));
pCanFrames[index] = new CAN_FRAME(pCANObj, DateTime.Now, CAN_FRAME_DIRECTION.RECEIVE, CAN_FRAME_STATUS.SUCCESS);
}
Marshal.FreeHGlobal(pReceive);
return(realRcvNum);
}
Marshal.FreeHGlobal(pReceive);
CAN_ERR_INFO pCANErrorInfo = new CAN_ERR_INFO();
uint result = (uint)CAN_RESULT.ERR_UNKNOWN;
if (ReadErrInfo(ref pCANErrorInfo) == (uint)CAN_RESULT.SUCCESSFUL)
{
result = pCANErrorInfo.ErrCode;
}
Logger.Info(string.Format("channel[{0}] receive failed: [0x{1}].", m_ChannelName, result.ToString("x")));
return(realRcvNum);
}
catch (Exception e)
{
Logger.Error(string.Format("channel[{0}] receive exception.", m_ChannelName), e);
return(realRcvNum);
}
}
