CanOpenSlaveDevice.cs 29 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885
  1. using CanTest;
  2. using System;
  3. using System.Collections.Generic;
  4. using System.Linq;
  5. using System.Text;
  6. using System.Threading;
  7. using System.Threading.Tasks;
  8. namespace CCDCount.DLL.CanBus
  9. {
  10. /// <summary>
  11. /// CANopen从站设备 - 基于Nameless.eds文件实现
  12. /// 支持4个RPDO和4个TPDO,符合CiA DS301标准
  13. /// </summary>
  14. public class CanOpenSlaveDevice : IDisposable
  15. {
  16. #region 私有字段
  17. private CanOpenManager m_canManager;
  18. private byte m_nodeId = 1; // 默认节点ID
  19. private NmtState m_currentState = NmtState.Initializing;
  20. // PDO配置 - 根据EDS文件定义
  21. private PdoConfig[] m_rpdoConfigs = new PdoConfig[4]; // 接收PDO
  22. private PdoConfig[] m_tpdoConfigs = new PdoConfig[4]; // 发送PDO
  23. // PDO映射对象
  24. private PdoMapping[,] m_rpdoMappings = new PdoMapping[4, 4]; // RPDO映射表
  25. private PdoMapping[,] m_tpdoMappings = new PdoMapping[4, 4]; // TPDO映射表
  26. // 应用数据缓冲区 (用于PDO数据交换)
  27. private Dictionary<ushort, object> m_objectDictionary = new Dictionary<ushort, object>();
  28. // 心跳参数
  29. private ushort m_producerHeartbeatTime = 0; // 心跳时间(ms),0表示禁用
  30. private Timer m_heartbeatTimer;
  31. // SYNC参数
  32. private bool m_syncEnabled = false;
  33. private byte m_syncCounter = 0;
  34. // 线程控制
  35. private CancellationTokenSource m_cancellationTokenSource;
  36. private Task m_receiveTask;
  37. private bool m_isRunning = false;
  38. #endregion
  39. #region 事件定义
  40. /// <summary>
  41. /// RPDO接收事件
  42. /// </summary>
  43. public event Action<byte, byte, byte[]> OnRpdoReceived;
  44. /// <summary>
  45. /// NMT状态改变事件
  46. /// </summary>
  47. public event Action<NmtState, NmtState> OnNmtStateChanged;
  48. /// <summary>
  49. /// SDO读取请求事件
  50. /// </summary>
  51. public event Action<byte, ushort, byte> OnSdoReadRequest;
  52. /// <summary>
  53. /// SDO写入请求事件
  54. /// </summary>
  55. public event Action<byte, ushort, byte, uint> OnSdoWriteRequest;
  56. #endregion
  57. #region 构造函数
  58. /// <summary>
  59. /// 构造函数
  60. /// </summary>
  61. /// <param name="nodeId">节点ID(1-127)</param>
  62. /// <param name="deviceType">设备类型</param>
  63. /// <param name="deviceIndex">设备索引</param>
  64. /// <param name="canIndex">CAN通道索引</param>
  65. public CanOpenSlaveDevice(byte nodeId = 1, UInt32 deviceType = 4, UInt32 deviceIndex = 0, UInt32 canIndex = 0)
  66. {
  67. if (nodeId < 1 || nodeId > 127)
  68. throw new ArgumentException("节点ID必须在1-127之间");
  69. m_nodeId = nodeId;
  70. m_canManager = new CanOpenManager(deviceType, deviceIndex, canIndex);
  71. InitializePdoConfigs();
  72. InitializeObjectDictionary();
  73. }
  74. #endregion
  75. #region 初始化方法
  76. /// <summary>
  77. /// 初始化PDO配置 - 根据EDS文件
  78. /// </summary>
  79. private void InitializePdoConfigs()
  80. {
  81. // 初始化RPDO配置 (1400-1403)
  82. for (int i = 0; i < 4; i++)
  83. {
  84. m_rpdoConfigs[i] = new PdoConfig
  85. {
  86. CobId = GetRpdoCobId((byte)(i + 1), m_nodeId),
  87. TransmissionType = 0xFF, // 事件驱动
  88. Enabled = true
  89. };
  90. // 初始化映射表为空
  91. for (int j = 0; j < 4; j++)
  92. {
  93. m_rpdoMappings[i, j] = new PdoMapping
  94. {
  95. Index = 0,
  96. SubIndex = 0,
  97. BitLength = 0
  98. };
  99. }
  100. }
  101. // 初始化TPDO配置 (1800-1803)
  102. for (int i = 0; i < 4; i++)
  103. {
  104. m_tpdoConfigs[i] = new PdoConfig
  105. {
  106. CobId = GetTpdoCobId((byte)(i + 1), m_nodeId),
  107. TransmissionType = 0xFF, // 事件驱动
  108. Enabled = true
  109. };
  110. // 初始化映射表为空
  111. for (int j = 0; j < 4; j++)
  112. {
  113. m_tpdoMappings[i, j] = new PdoMapping
  114. {
  115. Index = 0,
  116. SubIndex = 0,
  117. BitLength = 0
  118. };
  119. }
  120. }
  121. }
  122. /// <summary>
  123. /// 初始化对象字典 - 根据EDS文件定义
  124. /// </summary>
  125. private void InitializeObjectDictionary()
  126. {
  127. // 1000h - Device type
  128. m_objectDictionary[(ushort)0x1000] = (uint)0x00000000; // 默认值
  129. // 1001h - Error register
  130. m_objectDictionary[(ushort)0x1001] = (byte)0x00;
  131. // 1018h - Identity Object
  132. m_objectDictionary[(ushort)0x1018] = new IdentityObject
  133. {
  134. VendorId = 0x0000000D, // HanLin
  135. ProductCode = 0x00000001, // CCDCountCanOpenSlave
  136. RevisionNumber = 0x00010001
  137. };
  138. // 1800-1803h - TPDO communication parameters
  139. for (int i = 0; i < 4; i++)
  140. {
  141. m_objectDictionary[(ushort)(0x1800 + i)] = new TpdoCommParam
  142. {
  143. CobId = GetTpdoCobId((byte)(i + 1), m_nodeId),
  144. TransmissionType = 0xFF
  145. };
  146. }
  147. // 1A00-1A03h - TPDO mapping parameters
  148. for (int i = 0; i < 4; i++)
  149. {
  150. m_objectDictionary[(ushort)(0x1A00 + i)] = new PdoMappingParam
  151. {
  152. NumberOfEntries = 4,
  153. Mappings = new uint[4]
  154. };
  155. }
  156. // 1400-1403h - RPDO communication parameters
  157. for (int i = 0; i < 4; i++)
  158. {
  159. m_objectDictionary[(ushort)(0x1400 + i)] = new RpdoCommParam
  160. {
  161. CobId = GetRpdoCobId((byte)(i + 1), m_nodeId),
  162. TransmissionType = 0xFF
  163. };
  164. }
  165. // 1600-1603h - RPDO mapping parameters
  166. for (int i = 0; i < 4; i++)
  167. {
  168. m_objectDictionary[(ushort)(0x1600 + i)] = new PdoMappingParam
  169. {
  170. NumberOfEntries = 4,
  171. Mappings = new uint[4]
  172. };
  173. }
  174. }
  175. #endregion
  176. #region 启动和停止
  177. /// <summary>
  178. /// 启动从站设备
  179. /// </summary>
  180. /// <param name="baudRate">波特率</param>
  181. /// <returns>是否成功</returns>
  182. public bool Start(CanBaudRate baudRate = CanBaudRate.BaudRate_1M)
  183. {
  184. if (m_isRunning)
  185. {
  186. Console.WriteLine("从站设备已在运行");
  187. return true;
  188. }
  189. // 初始化CAN
  190. if (!m_canManager.Initialize(baudRate))
  191. {
  192. Console.WriteLine("CAN初始化失败");
  193. return false;
  194. }
  195. m_isRunning = true;
  196. m_currentState = NmtState.PreOperational;
  197. // 启动接收线程
  198. m_cancellationTokenSource = new CancellationTokenSource();
  199. m_receiveTask = Task.Run(() => ReceiveLoop(m_cancellationTokenSource.Token));
  200. Console.WriteLine($"CANopen从站启动成功 - 节点ID: {m_nodeId}");
  201. return true;
  202. }
  203. /// <summary>
  204. /// 停止从站设备
  205. /// </summary>
  206. public void Stop()
  207. {
  208. if (!m_isRunning)
  209. return;
  210. m_isRunning = false;
  211. // 停止接收线程
  212. m_cancellationTokenSource?.Cancel();
  213. m_receiveTask?.Wait(1000);
  214. m_receiveTask?.Dispose();
  215. // 停止心跳定时器
  216. m_heartbeatTimer?.Dispose();
  217. // 关闭CAN
  218. m_canManager.Close();
  219. m_currentState = NmtState.Stopped;
  220. Console.WriteLine("CANopen从站已停止");
  221. }
  222. #endregion
  223. #region 接收处理循环
  224. /// <summary>
  225. /// CAN帧接收循环
  226. /// </summary>
  227. private void ReceiveLoop(CancellationToken cancellationToken)
  228. {
  229. while (!cancellationToken.IsCancellationRequested)
  230. {
  231. try
  232. {
  233. var frames = m_canManager.ReceiveCanFrames(50);
  234. foreach (var frame in frames)
  235. {
  236. ProcessCanFrame(frame);
  237. }
  238. }
  239. catch (Exception ex)
  240. {
  241. Console.WriteLine($"接收错误: {ex.Message}");
  242. }
  243. Thread.Sleep(1); // 避免CPU占用过高
  244. }
  245. }
  246. /// <summary>
  247. /// 处理接收到的CAN帧
  248. /// </summary>
  249. private void ProcessCanFrame(CanOpenFrame frame)
  250. {
  251. // 检查是否是NMT命令 (COB-ID = 0x000)
  252. if (frame.CobId == (uint)0x000 && frame.DataLength >= 2)
  253. {
  254. ProcessNmtCommand(frame.Data);
  255. return;
  256. }
  257. // 检查是否是SYNC (COB-ID = 0x080)
  258. if (frame.CobId == (uint)0x080)
  259. {
  260. ProcessSync(frame.Data);
  261. return;
  262. }
  263. // 检查是否是SDO请求 (COB-ID = 0x600 + nodeId)
  264. uint sdoRequestCobId = (uint)0x600 + m_nodeId;
  265. if (frame.CobId == sdoRequestCobId)
  266. {
  267. ProcessSdoRequest(frame.Data);
  268. return;
  269. }
  270. // 检查是否是RPDO
  271. for (int i = 0; i < 4; i++)
  272. {
  273. if (frame.CobId == m_rpdoConfigs[i].CobId && m_rpdoConfigs[i].Enabled)
  274. {
  275. ProcessRpdo((byte)(i + 1), frame.Data, frame.DataLength);
  276. return;
  277. }
  278. }
  279. }
  280. #endregion
  281. #region NMT处理
  282. /// <summary>
  283. /// 处理NMT命令
  284. /// </summary>
  285. private void ProcessNmtCommand(byte[] data)
  286. {
  287. byte commandSpecifier = data[0];
  288. byte nodeId = data[1];
  289. // 检查是否是广播命令或针对本节点的命令
  290. if (nodeId != 0 && nodeId != m_nodeId)
  291. return;
  292. NmtState oldState = m_currentState;
  293. switch (commandSpecifier)
  294. {
  295. case 0x01: // 启动节点
  296. m_currentState = NmtState.Operational;
  297. Console.WriteLine($"NMT: 节点{m_nodeId}进入运行状态");
  298. break;
  299. case 0x02: // 停止节点
  300. m_currentState = NmtState.Stopped;
  301. Console.WriteLine($"NMT: 节点{m_nodeId}进入停止状态");
  302. break;
  303. case 0x80: // 进入预操作状态
  304. m_currentState = NmtState.PreOperational;
  305. Console.WriteLine($"NMT: 节点{m_nodeId}进入预操作状态");
  306. break;
  307. case 0x81: // 重置节点
  308. m_currentState = NmtState.Initializing;
  309. Console.WriteLine($"NMT: 节点{m_nodeId}重置");
  310. // TODO: 执行节点重置逻辑
  311. m_currentState = NmtState.PreOperational;
  312. break;
  313. case 0x82: // 重置通信
  314. m_currentState = NmtState.PreOperational;
  315. Console.WriteLine($"NMT: 节点{m_nodeId}通信重置");
  316. // TODO: 执行通信重置逻辑
  317. break;
  318. }
  319. // 触发状态改变事件
  320. if (oldState != m_currentState)
  321. {
  322. OnNmtStateChanged?.Invoke(oldState, m_currentState);
  323. }
  324. }
  325. #endregion
  326. #region SYNC处理
  327. /// <summary>
  328. /// 处理SYNC帧
  329. /// </summary>
  330. private void ProcessSync(byte[] data)
  331. {
  332. if (data.Length > 0)
  333. {
  334. m_syncCounter = data[0];
  335. }
  336. // 如果TPDO配置为同步触发,则发送
  337. for (int i = 0; i < 4; i++)
  338. {
  339. if (m_tpdoConfigs[i].Enabled &&
  340. m_tpdoConfigs[i].TransmissionType >= 1 &&
  341. m_tpdoConfigs[i].TransmissionType <= 240)
  342. {
  343. SendTpdo((byte)(i + 1));
  344. }
  345. }
  346. }
  347. #endregion
  348. #region SDO处理
  349. /// <summary>
  350. /// 处理SDO请求
  351. /// </summary>
  352. private void ProcessSdoRequest(byte[] data)
  353. {
  354. if (data.Length < 8)
  355. return;
  356. byte cs = (byte)(data[0] >> 5); // 命令 specifier
  357. ushort index = (ushort)(data[1] | (data[2] << 8));
  358. byte subIndex = data[3];
  359. switch (cs)
  360. {
  361. case 2: // SDO上传请求 (读)
  362. HandleSdoUpload(index, subIndex);
  363. break;
  364. case 1: // SDO下载请求 (写)
  365. HandleSdoDownload(index, subIndex, data);
  366. break;
  367. default:
  368. Console.WriteLine($"未支持的SDO命令: CS={cs}");
  369. break;
  370. }
  371. }
  372. /// <summary>
  373. /// 处理SDO上传 (读对象字典)
  374. /// </summary>
  375. private void HandleSdoUpload(ushort index, byte subIndex)
  376. {
  377. byte[] response = new byte[8];
  378. // 触发自定义事件
  379. OnSdoReadRequest?.Invoke(m_nodeId, index, subIndex);
  380. // 根据索引返回数据
  381. if (m_objectDictionary.TryGetValue(index, out object value))
  382. {
  383. if (subIndex == 0)
  384. {
  385. // 返回子索引数量
  386. response[0] = 0x4F; // 快速上传响应
  387. response[1] = (byte)(index & 0xFF);
  388. response[2] = (byte)(index >> 8);
  389. response[3] = subIndex;
  390. if (value is IdentityObject identity)
  391. {
  392. response[4] = 4; // 4个子条目
  393. }
  394. else if (value is PdoMappingParam mappingParam)
  395. {
  396. response[4] = mappingParam.NumberOfEntries;
  397. }
  398. else
  399. {
  400. response[4] = 0;
  401. }
  402. }
  403. else
  404. {
  405. // 返回具体子索引的值
  406. response[0] = 0x4B; // 4字节快速上传
  407. response[1] = (byte)(index & 0xFF);
  408. response[2] = (byte)(index >> 8);
  409. response[3] = subIndex;
  410. uint dataValue = 0;
  411. if (index == (ushort)0x1000 && value is uint deviceType)
  412. {
  413. dataValue = deviceType;
  414. }
  415. else if (index == (ushort)0x1001 && value is byte errorReg)
  416. {
  417. response[0] = 0x4F; // 1字节
  418. dataValue = errorReg;
  419. }
  420. else if (index == (ushort)0x1018 && value is IdentityObject identity)
  421. {
  422. response[0] = 0x4B;
  423. switch (subIndex)
  424. {
  425. case 1: dataValue = identity.VendorId; break;
  426. case 2: dataValue = identity.ProductCode; break;
  427. case 3: dataValue = identity.RevisionNumber; break;
  428. default: dataValue = 0; break;
  429. }
  430. }
  431. else if ((index >= (ushort)0x1800 && index <= (ushort)0x1803) && value is TpdoCommParam tpdoParam)
  432. {
  433. switch (subIndex)
  434. {
  435. case 1: dataValue = tpdoParam.CobId; break;
  436. case 2: dataValue = tpdoParam.TransmissionType; break;
  437. default: dataValue = 0; break;
  438. }
  439. }
  440. else if ((index >= (ushort)0x1400 && index <= (ushort)0x1403) && value is RpdoCommParam rpdoParam)
  441. {
  442. switch (subIndex)
  443. {
  444. case 1: dataValue = rpdoParam.CobId; break;
  445. case 2: dataValue = rpdoParam.TransmissionType; break;
  446. default: dataValue = 0; break;
  447. }
  448. }
  449. response[4] = (byte)(dataValue & 0xFF);
  450. response[5] = (byte)((dataValue >> 8) & 0xFF);
  451. response[6] = (byte)((dataValue >> 16) & 0xFF);
  452. response[7] = (byte)((dataValue >> 24) & 0xFF);
  453. }
  454. // 发送SDO响应
  455. uint responseCobId = (uint)0x580 + m_nodeId;
  456. m_canManager.SendCanFrame(responseCobId, response);
  457. }
  458. else
  459. {
  460. // 对象不存在,发送错误响应
  461. response[0] = 0x80; // 错误响应
  462. response[1] = (byte)(index & 0xFF);
  463. response[2] = (byte)(index >> 8);
  464. response[3] = subIndex;
  465. response[4] = 0x06; // 错误代码: 对象不存在
  466. response[5] = 0x02;
  467. response[6] = 0x00;
  468. response[7] = 0x00;
  469. uint responseCobId = (uint)0x580 + m_nodeId;
  470. m_canManager.SendCanFrame(responseCobId, response);
  471. }
  472. }
  473. /// <summary>
  474. /// 处理SDO下载 (写对象字典)
  475. /// </summary>
  476. private void HandleSdoDownload(ushort index, byte subIndex, byte[] data)
  477. {
  478. uint value = (uint)(data[4] | (data[5] << 8) | (data[6] << 16) | (data[7] << 24));
  479. // 触发自定义事件
  480. OnSdoWriteRequest?.Invoke(m_nodeId, index, subIndex, value);
  481. // 更新对象字典
  482. if (m_objectDictionary.ContainsKey(index))
  483. {
  484. if (index >= (ushort)0x1800 && index <= (ushort)0x1803 && m_objectDictionary[index] is TpdoCommParam tpdoParam)
  485. {
  486. int pdoIndex = index - (ushort)0x1800;
  487. if (subIndex == 1)
  488. {
  489. tpdoParam.CobId = value;
  490. m_tpdoConfigs[pdoIndex].CobId = value;
  491. }
  492. else if (subIndex == 2)
  493. {
  494. tpdoParam.TransmissionType = (byte)value;
  495. m_tpdoConfigs[pdoIndex].TransmissionType = (byte)value;
  496. }
  497. }
  498. else if (index >= (ushort)0x1400 && index <= (ushort)0x1403 && m_objectDictionary[index] is RpdoCommParam rpdoParam)
  499. {
  500. int pdoIndex = index - (ushort)0x1400;
  501. if (subIndex == 1)
  502. {
  503. rpdoParam.CobId = value;
  504. m_rpdoConfigs[pdoIndex].CobId = value;
  505. }
  506. else if (subIndex == 2)
  507. {
  508. rpdoParam.TransmissionType = (byte)value;
  509. m_rpdoConfigs[pdoIndex].TransmissionType = (byte)value;
  510. }
  511. }
  512. }
  513. // 发送SDO确认响应
  514. byte[] response = new byte[8];
  515. response[0] = 0x60; // SDO下载确认
  516. response[1] = (byte)(index & 0xFF);
  517. response[2] = (byte)(index >> 8);
  518. response[3] = subIndex;
  519. uint responseCobId = (uint)0x580 + m_nodeId;
  520. m_canManager.SendCanFrame(responseCobId, response);
  521. }
  522. #endregion
  523. #region RPDO处理
  524. /// <summary>
  525. /// 处理接收到的RPDO
  526. /// </summary>
  527. private void ProcessRpdo(byte pdoNumber, byte[] data, byte length)
  528. {
  529. Console.WriteLine($"收到RPDO{pdoNumber}: 长度{length}字节");
  530. // 复制有效数据
  531. byte[] validData = new byte[length];
  532. Array.Copy(data, validData, length);
  533. // 触发事件
  534. OnRpdoReceived?.Invoke(m_nodeId, pdoNumber, validData);
  535. }
  536. #endregion
  537. #region TPDO发送
  538. /// <summary>
  539. /// 发送TPDO
  540. /// </summary>
  541. public void SendTpdo(byte pdoNumber)
  542. {
  543. if (pdoNumber < 1 || pdoNumber > 4)
  544. throw new ArgumentException("PDO编号必须在1-4之间");
  545. if (!m_tpdoConfigs[pdoNumber - 1].Enabled)
  546. {
  547. Console.WriteLine($"TPDO{pdoNumber}未启用");
  548. return;
  549. }
  550. // TODO: 根据映射表构建PDO数据
  551. // 这里使用示例数据
  552. byte[] pdoData = new byte[8];
  553. // 示例: 填充一些测试数据
  554. pdoData[0] = (byte)(m_syncCounter & 0xFF);
  555. pdoData[1] = (byte)((m_syncCounter >> 8) & 0xFF);
  556. uint cobId = m_tpdoConfigs[pdoNumber - 1].CobId;
  557. m_canManager.SendCanFrame(cobId, pdoData);
  558. Console.WriteLine($"发送TPDO{pdoNumber}: COB-ID 0x{cobId:X3}");
  559. }
  560. /// <summary>
  561. /// 发送所有启用的TPDO
  562. /// </summary>
  563. public void SendAllTpdos()
  564. {
  565. for (byte i = 1; i <= 4; i++)
  566. {
  567. if (m_tpdoConfigs[i - 1].Enabled)
  568. {
  569. SendTpdo(i);
  570. }
  571. }
  572. }
  573. #endregion
  574. #region 心跳机制
  575. /// <summary>
  576. /// 配置心跳
  577. /// </summary>
  578. /// <param name="heartbeatTimeMs">心跳时间(毫秒),0表示禁用</param>
  579. public void ConfigureHeartbeat(ushort heartbeatTimeMs)
  580. {
  581. m_producerHeartbeatTime = heartbeatTimeMs;
  582. // 停止旧的定时器
  583. m_heartbeatTimer?.Dispose();
  584. if (heartbeatTimeMs > 0)
  585. {
  586. // 创建新的定时器
  587. m_heartbeatTimer = new Timer(state =>
  588. {
  589. if (m_currentState == NmtState.Operational ||
  590. m_currentState == NmtState.PreOperational)
  591. {
  592. SendHeartbeat();
  593. }
  594. }, null, heartbeatTimeMs, heartbeatTimeMs);
  595. Console.WriteLine($"心跳已配置: {heartbeatTimeMs}ms");
  596. }
  597. else
  598. {
  599. Console.WriteLine("心跳已禁用");
  600. }
  601. }
  602. /// <summary>
  603. /// 发送心跳
  604. /// </summary>
  605. private void SendHeartbeat()
  606. {
  607. byte[] heartbeatData = new byte[1];
  608. // 根据当前状态设置心跳字节
  609. switch (m_currentState)
  610. {
  611. case NmtState.Initializing:
  612. heartbeatData[0] = 0x00;
  613. break;
  614. case NmtState.PreOperational:
  615. heartbeatData[0] = 0x7F;
  616. break;
  617. case NmtState.Operational:
  618. heartbeatData[0] = 0x05;
  619. break;
  620. case NmtState.Stopped:
  621. heartbeatData[0] = 0x04;
  622. break;
  623. default:
  624. heartbeatData[0] = 0x00;
  625. break;
  626. }
  627. uint heartbeatCobId = (uint)0x700 + (uint)m_nodeId;
  628. m_canManager.SendCanFrame(heartbeatCobId, heartbeatData);
  629. }
  630. #endregion
  631. #region 辅助方法
  632. /// <summary>
  633. /// 获取RPDO的COB-ID
  634. /// </summary>
  635. private uint GetRpdoCobId(byte pdoNumber, byte nodeId)
  636. {
  637. switch (pdoNumber)
  638. {
  639. case 1: return (uint)0x200 + nodeId;
  640. case 2: return (uint)0x300 + nodeId;
  641. case 3: return (uint)0x400 + nodeId;
  642. case 4: return (uint)0x500 + nodeId;
  643. default: throw new ArgumentException("无效的PDO编号");
  644. }
  645. }
  646. /// <summary>
  647. /// 获取TPDO的COB-ID
  648. /// </summary>
  649. private uint GetTpdoCobId(byte pdoNumber, byte nodeId)
  650. {
  651. switch (pdoNumber)
  652. {
  653. case 1: return (uint)0x180 + nodeId;
  654. case 2: return (uint)0x280 + nodeId;
  655. case 3: return (uint)0x380 + nodeId;
  656. case 4: return (uint)0x480 + nodeId;
  657. default: throw new ArgumentException("无效的PDO编号");
  658. }
  659. }
  660. #endregion
  661. #region 资源管理
  662. /// <summary>
  663. /// 释放资源
  664. /// </summary>
  665. public void Dispose()
  666. {
  667. Stop();
  668. m_canManager?.Dispose();
  669. m_cancellationTokenSource?.Dispose();
  670. m_heartbeatTimer?.Dispose();
  671. }
  672. #endregion
  673. #region 公共属性
  674. /// <summary>
  675. /// 获取当前节点ID
  676. /// </summary>
  677. public byte NodeId => m_nodeId;
  678. /// <summary>
  679. /// 获取当前NMT状态
  680. /// </summary>
  681. public NmtState CurrentState => m_currentState;
  682. /// <summary>
  683. /// 获取是否正在运行
  684. /// </summary>
  685. public bool IsRunning => m_isRunning;
  686. #endregion
  687. }
  688. #region 数据结构定义
  689. /// <summary>
  690. /// NMT状态枚举
  691. /// </summary>
  692. public enum NmtState
  693. {
  694. Initializing = 0x00,
  695. PreOperational = 0x7F,
  696. Operational = 0x05,
  697. Stopped = 0x04
  698. }
  699. /// <summary>
  700. /// PDO配置
  701. /// </summary>
  702. public class PdoConfig
  703. {
  704. public uint CobId { get; set; }
  705. public byte TransmissionType { get; set; } // 0xFF=事件驱动, 1-240=同步周期
  706. public bool Enabled { get; set; }
  707. }
  708. /// <summary>
  709. /// PDO映射
  710. /// </summary>
  711. public class PdoMapping
  712. {
  713. public ushort Index { get; set; }
  714. public byte SubIndex { get; set; }
  715. public byte BitLength { get; set; }
  716. }
  717. /// <summary>
  718. /// PDO映射参数
  719. /// </summary>
  720. public class PdoMappingParam
  721. {
  722. public byte NumberOfEntries { get; set; }
  723. public uint[] Mappings { get; set; }
  724. }
  725. /// <summary>
  726. /// 身份对象 (1018h)
  727. /// </summary>
  728. public class IdentityObject
  729. {
  730. public uint VendorId { get; set; }
  731. public uint ProductCode { get; set; }
  732. public uint RevisionNumber { get; set; }
  733. }
  734. /// <summary>
  735. /// TPDO通信参数 (1800-1803h)
  736. /// </summary>
  737. public class TpdoCommParam
  738. {
  739. public uint CobId { get; set; }
  740. public byte TransmissionType { get; set; }
  741. }
  742. /// <summary>
  743. /// RPDO通信参数 (1400-1403h)
  744. /// </summary>
  745. public class RpdoCommParam
  746. {
  747. public uint CobId { get; set; }
  748. public byte TransmissionType { get; set; }
  749. }
  750. #endregion
  751. }