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); } }