EtherCAT有线转无线通信的机器臂控制系统

本发明涉及机器人，特别是一种ethercat有线转无线通信的机器臂控制系统。

背景技术：

1、机器臂是一个高精度、多输入多输出、高非线性、强耦合的复杂系统。由于其独特的操作灵活性，它已广泛应用于工业装配、安全和防爆等众多领域。

2、目前，现有的机器臂系统大都采用ethercat总线方式，以实现管理节点与各个终端节点进行数据通信，实时、快速、精准传送生产参数、工况信息、控制指令等。但在实际生产过程中，机器臂要长时间实现多种操作与相应的动作，如前后来回移动、上下翻转、左右转动等。机器臂工作时间久了，容易使机器臂末端的有线ethercat的数据线发生缠绕，甚至脱落、折断等现象，进而造成设备走位，甚至停机的故障。这样轻则影响生产，耽搁生产进度、降低生产效率；重则造成生产事故，乃至重大事故，给生产单位造成不可挽回的重大损失。为此，生产单位迫切一套高效的、稳定的能使ethercat有线方式转化为无线通信的机器臂系统，以克服目前存在的弊端与突破上述存在的问题。

3、目前无线通信的方式有多种方式，如4g、5g、蓝牙(bluetooth)、wifi、zigbee、红外等。由于4g、5g需要使用sim卡，数据通信将产生费用，成本高。而蓝牙(bluetooth)、wifi、zigbee占用ism频段，将不产生通信费用。但是由于生产车间内工况复杂，如有极强的干扰信号，如电磁信号等，而蓝牙、wifi、zigbee无法抗拒干扰信号，进而容易产生数据丢包，根本无法确保稳定、可靠的数据通信。

技术实现思路

1、为解决现有技术中存在的问题，本发明的目的是提供一种ethercat有线转无线通信的机器臂控制系统，本发明采用fhss跳频技术，有效规避了由工况、电磁干扰信号所造成的影响，有效保障了工作效率。

2、为实现上述目的，本发明采用的技术方案是：一种ethercat有线转无线通信的机器臂控制系统，包括管理中心上位机plc、机器臂无线通信管理中心、多个机器臂无线通信终端和多个通信终端下位机plc；所述管理中心上位机plc通过ethercat总线与所述机器臂无线通信管理中心通信连接，所述机器臂无线通信管理中心通过跳频无线通信技术fhss与多个所述机器臂无线通信终端通信连接，且机器臂无线通信终端和机器臂无线通信管理中心之间通过加密算法进行数据传输，多个所述机器臂无线通信终端分别通过ethercat总线与多个所述通信终端下位机plc一一通信连接。

3、作为本发明的进一步改进，所述机器臂无线通信终端和机器臂无线通信管理中心之间通过加密算法进行数据传输具体包括以下步骤：

4、步骤1、第一次对原始数据进行传输：发送方在原始数据前面加上帧头标志值，在原始数据后面加上数据结束标志值、以及原始数据的长度信息和差错控制信息的数据值，然后再增加帧尾标志值；接收方按照传输协议规定的方式进行接收数据，原始数据接收完毕后，接收方首先验证接收到的数据中依次是否含有帧头标志值、数据结束标志值和帧尾标志值这三个数据帧的标志值；如果含有，则统计接收到的原始数据长度，对接收到的原始数据按照既定的差错控制协议，现场生成差错控制信息，然后把接收的数据长度信息与现场数据长度信息作比较，接收到的差错控制信息与现场生成的差错控制信息作比较，如果两种信息的比较结果均一致，说明接收到的信息是完备的，接收方立即给发送方返回第一次接收的数据是完备的应答标志值；

5、步骤2、第二次对加密数据进行传输：发送方接收到接收方发来的数据应答标志值后，再次进行第二次数据传输，第二次传输的数据是第一次原始数据加密之后形成的新数据，即加密数据；发送方在加密数据前面加上帧头标志值，在加密数据后面加上数据结束标志值、以及增加加密数据的长度信息、差错控制信息的数据值，然后再增加帧尾标志值；接收方按照传输协议规定的方式进行接收加密数据，加密数据接收完毕后，接收方首先验证接收到的数据中依次是否含有帧头标志值、数据结束标志值和帧尾标志值这三个数据帧的标志值；如果含有，则统计接收到的现场数据长度，对接收到的加密数据按照既定的差错控制协议，现场生成差错控制信息，然后把接收的加密数据长度信息与现场加密数据长度信息作比较，接收到的差错控制信息与现场生成的差错控制信息作比较，如果两种信息的比较结果均一致，说明接收到的信息是完备的，接收方立即给发送方返回第二次接收的加密数据是完备的应答标志值；

6、步骤3、接收方在接收到第二次的应答标志值，表示第二次数据接收是完备的，然后把接收的加密数据按照加密协议进行还原，得到一组解密数据，然后把解密数据与原始数据进行比对、研判，以验证两次的接收数据是否相同；如果相同，则存放在指定的内存单元，并给发送方反馈一个数据正常的标志值；如果不相同，则表示数据无效，数据不予存放，并且给发送方反馈一个数据不正常的标志值。发送方如果接收到数据正常的标志值，则执行后续的程序指令；发送方如果接收到数据不正常的标志值，则重复步骤1和步骤2。

7、作为本发明的进一步改进，如果接收方的数据中没有含有帧头标志值、数据结束标志值和帧尾标志值这三个数据帧标志值，或者并非按照帧头标志值、数据结束标志值和帧尾标志值这样的次序，则表示接收方接收的数据是无效的；另外，如果接收的数据长度信息与现场生成的数据长度信息不一致，或者接收到的差错控制信息与现场生成的差错控制信息不一致，也表示接收方接收的数据无效，则接收方给发送方返回接收数据无效标志值；发送方接收到接收方发来的数据无效标志值，则需对刚发送出错的原始数据重新再次发送，直至原始数据完整发送。

8、作为本发明的进一步改进，对原始数据加密具体包括：

9、在第一次传输的原始数据基础之上，按照一定的数学方法进行加密，生成一组与第一次传输的原始数据有关的新数据，即加密数据；所述的数学方法为把第一次传输的原始数据作为某一固定数学表达式或函数的参数，那么数学表达式或函数进行运算后所生成的结果作为加密后的新数据。

10、作为本发明的进一步改进，在步骤2中，对原始数据加密具体包括：如果接收的数据中没有含有帧头标志值、数据结束标志值和帧尾标志值这三个数据帧标志值，或者并非按照帧头标志值、数据结束标志值和帧尾标志值这样的次序，则表示接收方接收的数据是无效的；另外，如果接收的数据长度信息与现场生成的数据长度信息不一致，或者接收到的差错控制信息与现场生成的差错控制信息不一致，也表示接收方接收的数据无效，则接收方给发送方返回接收数据无效标志值；发送方接收到接收方发来的数据无效标志值，则需对刚发送出错的加密数据重新再次发送，直至加密数据完整发送。

11、作为本发明的进一步改进，每一个所述机器臂无线通信终端包括高性能处理器和与所述高性能处理器连接的fhss无线模块、ethercat总线接口、生产参数采集模块、数据显示模块和预警信息模块。

12、作为本发明的进一步改进，所述机器臂无线通信管理中心包括高性能微处理器和与所述高性能微处理器连接的fhss无线模块、ethercat总线接口和生产参数/预警信息显示模块，所述生产参数/预警信息显示模块与多个所述机器臂无线通信终端通信连接。

13、本发明的有益效果是：

14、1、本发明中由于机器臂终端与无线管理中心之间采用无线通信，有效避免了机器臂终端发生数据线缠绕、折断、脱落等故障，进而有效杜绝了设备走位，以及由于数据线缠绕、折断、脱落等造成的停机所引发的停机损失。从而有效提高了生产效率。

15、2、本发明采用fhss跳频技术，有效规避了由工况、电磁干扰信号所造成的影响，有效保障了工作效率。

16、3、本发明减少了由于数据线缠绕、折断、脱落等造成的维修，降低了生产成本，有效促进了生产效益。

17、4、本发明中由于机器臂无线通信终端存在着ethercat总线与无线通信fhss方式之间要实现数据交互，于是存在着大量的数据处理、融合、加密及与之相应的算法。如果ethercat总线转换为无线通信fhss方式，则在数据交互之前，得完成ethercat总线数据的提取。待数据提取完毕后，得按照无线通信fhss的数据格式实现无线传输。如果无线通信fhss方式转换为ethercat总线，则在交互之前，得完成无线通信fhss方式数据提取。待数据提取完毕后，得按照ethercat总线数据格式实现传输。

18、5、本发明利用跳频无线通信技术(fhss，frequency hopping spread spectrum)，具有极强的抗干扰能力，并采用高效的数据加密算法，从而有效规避了数据掉包，以确保高效的数据通信。