[发明专利]一种基于CAN总线的单兵转台伺服控制系统

说明书

技术领域

本发明涉及一种单兵转台伺服控制系统，特别是一种基于CAN总线的单兵转台伺服控制系统。

背景技术

目前，应用于转台的伺服系统主要由控制器、交流变频器、交流伺服电机、减速机和编码器组成。其中，交流变频器和交流伺服电机体积和质量较大，需要交流供电，主要用于质量大、体积大、负载大的转台，转台使用时固定在稳定基座上，不便于携带和搬运，不适于在野外或者无交流电源的工况下使用。

上述问题的存在，使得单兵转台伺服控制系统向小型化、轻型化、高精度发展面临着严峻的挑战。因此，减小伺服控制系统的体积和质量，提高调转、跟踪和定位精度就成为单兵转台伺服控制领域迫切需要解决的问题。

发明内容

本发明目的在于提供一种基于CAN总线的单兵转台伺服控制系统，解决传统转台体积大、质量大、不便于携带的问题。 

一种基于CAN总线的单兵转台伺服控制系统，包括：PLC控制器、方位驱动器、方位伺服电机、方位减速机、方位编码器、俯仰驱动器、俯仰伺服电机、俯仰减速机和俯仰编码器，还包括：24V蓄电池、方位负载、俯仰负载、运动指令输入设备、CAN2.0B协议总线、CANopen协议总线、方位驱动电缆、俯仰驱动电缆、供电电缆、方位反馈电缆和俯仰反馈电缆。方位伺服电机与方位减速机通过螺钉连接，方位伺服电机的输出轴与方位减速机的输入轴通过平键连接，方位减速机的输出轴与方位负载通过平键连接，方位编码器的输出轴与方位负载通过平键连接并随方位负载同步旋转。俯仰伺服电机与俯仰减速机通过螺钉连接，俯仰伺服电机的输出轴与俯仰减速机的输入轴通过平键连接，俯仰减速机的输出轴与俯仰负载通过平键连接，俯仰编码器的输出轴与俯仰负载通过平键连接并随俯仰负载同步旋转。24V蓄电池、PLC控制器、方位驱动器和俯仰驱动器均置于转台上并通过螺钉固定。24V蓄电池分别与PLC控制器、方位驱动器、俯仰驱动器、方位编码器、俯仰编码器以及运动指令输入设备通过供电电缆连接，PLC控制器分别与方位驱动器、俯仰驱动器以及运动指令输入设备通过CAN2.0B协议电缆连接，PLC控制器分别与方位编码器和俯仰编码器通过CANopen协议电缆连接，方位驱动器与方位伺服电机通过方位驱动电缆和方位反馈电缆连接；俯仰驱动器与俯仰伺服电机通过俯仰驱动电缆和俯仰反馈电缆连接。

打开24V蓄电池电源开关，给PLC控制器、方位驱动器、俯仰驱动器、方位编码器、俯仰编码器供24V直流电。上电后，方位编码器和俯仰编码器开始按照CANopen帧格式以f₁的频率发送当前转台的方位角度和俯仰角度到CANopen协议总线上；PLC控制器按照CAN2.0B帧格式发送初始化命令到CAN2.0B协议总线上，方位驱动器和俯仰驱动器接收到初始化命令后进行初始化；PLC控制器首先读取CANopen协议总线上的方位角度和俯仰角度，然后检测是否有运动指令到来，当运动指令输入设备将运动指令发送到CAN2.0B协议总线上时，PLC控制器读入运动指令。PLC控制器将运动指令与当前方位角度、俯仰角度作差，得到位置误差指令，将此位置误差指令作为位置PI控制闭环的输入指令，经过PI运算，PLC控制器输出速度指令到CAN2.0B协议总线上，当方位驱动器和俯仰驱动器接收到速度指令后分别通过方位驱动电缆和俯仰驱动电缆输出电压信号给方位伺服电机和俯仰伺服电机，从而驱动方位伺服电机和俯仰伺服电机运动；运动过程中，方位驱动器和俯仰驱动器分别通过方位反馈电缆和俯仰反馈电缆读取方位伺服电机和俯仰伺服电机的转速反馈信息，将反馈转速与指令转速的差值作为方位驱动器和俯仰驱动器内部速度PI控制闭环的输入，进行速度PI调节。

本发明具有结构紧凑、质量轻便，功率密度高便于携带，易操作的优点。具有较强的通讯抗干扰性，利于转台在复杂的电磁环境中使用。通过PI闭环控制实现了转台调转速度快、跟踪稳定度高、到位精度高等要求。 

附图说明

图1 一种基于CAN总线的单兵转台伺服控制系统。