[发明专利]一种用于6自由度并联机器人的专用运动控制器硬件平台

权利要求书

1.一种用于6自由度并联机器人的专用运动控制器硬件平台，其特征在于，包括输入输出模块、上位机通讯模块、采样模块、CAN总线模块、ARM微控制器与FPGA信息传输模块、数据存储模块、FPGA逻辑模块、ARM微控制器模块：

所述输入输出模块用于实现对外部器件的开关量控制；

所述上位机通讯模块用于所述ARM微控制器与上位机进行信息交互；

所述采样模块包括限位开关采样单元，所述限位开关采样单元用于获取电动缸上下限位开关器件的开关量信号；

所述CAN总线模块作为ARM微控制器与伺服驱动器连接的接口单元，通过信号线与伺服驱动器连接，用于实现以所述ARM微控制器和6台伺服驱动器组成的CAN总线网络的信息交互；

所述ARM微控制器与FPGA信息传输模块包括数据交互单元，所述数据交互单元采用SPI通讯方式，实现ARM微控制器与FPGA之间的数据交互；

所述数据存储模块用于保存控制系统的部分关键参数，采用I²C通信方式完成数据的交互；

所述FPGA逻辑模块对所述采样模块获得的数据进行处理后，通过所述ARM微控制器与FPGA信息传输模块实现与所述ARM微控制器模块的信息交互；

所述ARM微控制器模块通过所述上位机通讯模块与上位机连接，接收上位机的命令，并通过所述ARM微控制器与FPGA信息传输模块、所述CAN总线模块获取信息，然后通过所述CAN总线模块对伺服驱动器进行控制。

2.根据权利要求1所述的一种用于6自由度并联机器人的专用运动控制器硬件平台，其特征在于，所述上位机通讯模块采用RS422异步串行通讯方式，实现所述ARM微控制器与上位机的数据信息交互。

3.根据权利要求1所述的一种用于6自由度并联机器人的专用运动控制器硬件平台，其特征在于，所述采样模块还包括磁致伸缩长度传感器采样单元，其采用同步串行接口SSI进行数据采集，用于获取当前6根电动缸的伸缩量。

4.根据权利要求1所述的一种用于6自由度并联机器人的专用运动控制器硬件平台，其特征在于，CAN总线模块中，所述ARM微控制器为CAN总线网络中的主站，六台伺服驱动器作为CAN总线网络中独立的六个从站。

5.根据权利要求4所述的一种用于6自由度并联机器人的专用运动控制器硬件平台，其特征在于，所述CAN总线模块是以CANopen协议作为高级应用层协议，实现整个总线网络信息交互，包括如下功能：

1)所述主站，可分别控制所述从站的包括速度、加速度、运动量在内基本运动参数；根据需要可以对所述从站发送同步信号，以实现同步运动；

2)所述主站，可对所述从站的基本CANopen参数进行设定；

3)所述主站，可以控制所述从站进入各种不同的状态；

4)所述从站，分别发送伺服电机绝对编码器值给所述主站，供主站中各种功能模块及相关算法使用；

5)所述从站，分别发送各台驱动器及电机的状态给所述主站，发送的状态包括电机的电流、力矩、速度、驱动器状态、驱动器错误描述、总线状态。

6.根据权利要求1所述的一种用于6自由度并联机器人的专用运动控制器硬件平台，其特征在于，所述ARM微控制器与FPGA信息传输模块还包括中断信号单元，用于FPGA对ARM微控制器的中断请求。

7.根据权利要求1所述的一种用于6自由度并联机器人的专用运动控制器硬件平台，其特征在于，所述FPGA逻辑模块为FPGA最小系统。

8.根据权利要求1、3、7任一所述的一种用于6自由度并联机器人的专用运动控制器硬件平台，其特征在于，所述采样模块全部功能、所述ARM微控制器与FPGA信息传输模块的部分功能包括中断、SPI通讯是由FPGA来完成。

9.根据权利要求1所述的一种用于6自由度并联机器人的专用运动控制器硬件平台，其特征在于，所述ARM微控制器模块为ARM最小系统。

10.根据权利要求1、2、4、5、6任一所述的一种用于6自由度并联机器人的专用运动控制器硬件平台，其特征在于，所述上位机通讯模块、所述CAN总线模块全部功能、所述ARM微控制器与FPGA信息传输模块部分功能包括中断、SPI通讯，由ARM微控制器来完成。