CN104133414A - 一种基于can总线的单兵转台伺服控制*** - Google Patents

一种基于can总线的单兵转台伺服控制*** Download PDF

Info

Publication number
CN104133414A
CN104133414A CN201410364569.6A CN201410364569A CN104133414A CN 104133414 A CN104133414 A CN 104133414A CN 201410364569 A CN201410364569 A CN 201410364569A CN 104133414 A CN104133414 A CN 104133414A
Authority
CN
China
Prior art keywords
pitching
orientation
driver
cable
azimuth
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201410364569.6A
Other languages
English (en)
Inventor
于德营
何成峰
阎红亮
张文波
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Machinery Equipment Research Institute
Original Assignee
Beijing Machinery Equipment Research Institute
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Machinery Equipment Research Institute filed Critical Beijing Machinery Equipment Research Institute
Priority to CN201410364569.6A priority Critical patent/CN104133414A/zh
Publication of CN104133414A publication Critical patent/CN104133414A/zh
Pending legal-status Critical Current

Links

Landscapes

  • Control Of Position Or Direction (AREA)

Abstract

本发明公开了一种基于CAN总线的单兵转台伺服控制***，包括：24V蓄电池（1）、PLC控制器（2）、方位驱动器（3）、方位伺服电机（4）、方位减速机（5）、方位负载（6）、方位编码器（7）、俯仰驱动器（8）、俯仰伺服电机（9）、俯仰减速机（10）、俯仰负载（11）、俯仰编码器（12）、运动指令输入设备（13）、CAN2.0B协议总线（14）、CANopen协议总线（15）、方位驱动电缆（16）、俯仰驱动电缆（17）、供电电缆（18）、方位反馈电缆（19）和俯仰反馈电缆（20）。PLC控制器（2）发送角度指令给方位驱动器（3）和俯仰驱动器（8），驱动方位伺服电机（4）和俯仰伺服电机（9）旋转。本***具有体积小、质量轻、响应快、到位精度高、低噪声等优点。

Description

一种基于CAN总线的单兵转台伺服控制***
技术领域
本发明涉及一种单兵转台伺服控制***，特别是一种基于CAN总线的单兵转台伺服控制***。
背景技术
目前，应用于转台的伺服***主要由控制器、交流变频器、交流伺服电机、减速机和编码器组成。其中，交流变频器和交流伺服电机体积和质量较大，需要交流供电，主要用于质量大、体积大、负载大的转台，转台使用时固定在稳定基座上，不便于携带和搬运，不适于在野外或者无交流电源的工况下使用。
上述问题的存在，使得单兵转台伺服控制***向小型化、轻型化、高精度发展面临着严峻的挑战。因此，减小伺服控制***的体积和质量，提高调转、跟踪和定位精度就成为单兵转台伺服控制领域迫切需要解决的问题。
发明内容
本发明目的在于提供一种基于CAN总线的单兵转台伺服控制***，解决传统转台体积大、质量大、不便于携带的问题。 
一种基于CAN总线的单兵转台伺服控制***，包括：PLC控制器、方位驱动器、方位伺服电机、方位减速机、方位编码器、俯仰驱动器、俯仰伺服电机、俯仰减速机和俯仰编码器，还包括：24V蓄电池、方位负载、俯仰负载、运动指令输入设备、CAN2.0B协议总线、CANopen协议总线、方位驱动电缆、俯仰驱动电缆、供电电缆、方位反馈电缆和俯仰反馈电缆。方位伺服电机与方位减速机通过螺钉连接，方位伺服电机的输出轴与方位减速机的输入轴通过平键连接，方位减速机的输出轴与方位负载通过平键连接，方位编码器的输出轴与方位负载通过平键连接并随方位负载同步旋转。俯仰伺服电机与俯仰减速机通过螺钉连接，俯仰伺服电机的输出轴与俯仰减速机的输入轴通过平键连接，俯仰减速机的输出轴与俯仰负载通过平键连接，俯仰编码器的输出轴与俯仰负载通过平键连接并随俯仰负载同步旋转。24V蓄电池、PLC控制器、方位驱动器和俯仰驱动器均置于转台上并通过螺钉固定。24V蓄电池分别与PLC控制器、方位驱动器、俯仰驱动器、方位编码器、俯仰编码器以及运动指令输入设备通过供电电缆连接，PLC控制器分别与方位驱动器、俯仰驱动器以及运动指令输入设备通过CAN2.0B协议电缆连接，PLC控制器分别与方位编码器和俯仰编码器通过CANopen协议电缆连接，方位驱动器与方位伺服电机通过方位驱动电缆和方位反馈电缆连接；俯仰驱动器与俯仰伺服电机通过俯仰驱动电缆和俯仰反馈电缆连接。
打开24V蓄电池电源开关，给PLC控制器、方位驱动器、俯仰驱动器、方位编码器、俯仰编码器供24V直流电。上电后，方位编码器和俯仰编码器开始按照CANopen帧格式以f 1的频率发送当前转台的方位角度和俯仰角度到CANopen协议总线上；PLC控制器按照CAN2.0B帧格式发送初始化命令到CAN2.0B协议总线上，方位驱动器和俯仰驱动器接收到初始化命令后进行初始化；PLC控制器首先读取CANopen协议总线上的方位角度和俯仰角度，然后检测是否有运动指令到来，当运动指令输入设备将运动指令发送到CAN2.0B协议总线上时，PLC控制器读入运动指令。PLC控制器将运动指令与当前方位角度、俯仰角度作差，得到位置误差指令，将此位置误差指令作为位置PI控制闭环的输入指令，经过PI运算，PLC控制器输出速度指令到CAN2.0B协议总线上，当方位驱动器和俯仰驱动器接收到速度指令后分别通过方位驱动电缆和俯仰驱动电缆输出电压信号给方位伺服电机和俯仰伺服电机，从而驱动方位伺服电机和俯仰伺服电机运动；运动过程中，方位驱动器和俯仰驱动器分别通过方位反馈电缆和俯仰反馈电缆读取方位伺服电机和俯仰伺服电机的转速反馈信息，将反馈转速与指令转速的差值作为方位驱动器和俯仰驱动器内部速度PI控制闭环的输入，进行速度PI调节。
本发明具有结构紧凑、质量轻便，功率密度高便于携带，易操作的优点。具有较强的通讯抗干扰性，利于转台在复杂的电磁环境中使用。通过PI闭环控制实现了转台调转速度快、跟踪稳定度高、到位精度高等要求。 
附图说明
图1 一种基于CAN总线的单兵转台伺服控制***。 
1.24V蓄电池   2.PLC控制器   3.方位驱动器   4.方位伺服电机   5.方位减速机   6.方位负载   7.方位编码器   8.俯仰驱动器   9.俯仰伺服电机   10.俯仰减速机   11.俯仰负载   12.俯仰编码器   13.运动指令输入设备   14.CAN2.0B协议总线   15.CANopen协议总线   16.方位驱动电缆   17.俯仰驱动电缆   18.供电电缆   19.方位反馈电缆   20.俯仰反馈电缆。  
具体实施方式
一种基于CAN总线的单兵转台伺服控制***，包括： PLC控制器2、方位驱动器3、方位伺服电机4、方位减速机5、方位编码器7、俯仰驱动器8、俯仰伺服电机9、俯仰减速机10、俯仰编码器12，还包括：24V蓄电池1、方位负载6、俯仰负载11、运动指令输入设备13、CAN2.0B协议总线14、CANopen协议总线15、方位驱动电缆16、俯仰驱动电缆17、供电电缆18、方位反馈电缆19、俯仰反馈电缆20。方位伺服电机4与方位减速机5通过螺钉连接，方位伺服电机4输出轴与方位减速机5输入轴通过平键连接，方位减速机5输出轴与方位负载6通过平键连接，方位编码器7输出轴通过平键与方位负载6连接并随方位负载6同步旋转。俯仰伺服电机9与俯仰减速机10通过螺钉连接，俯仰伺服电机9输出轴与俯仰减速机10输入轴通过平键连接，俯仰减速机10输出轴与俯仰负载11通过平键连接，俯仰编码器12输出轴通过平键与俯仰负载11连接并随俯仰负载11同步旋转。24V蓄电池1、PLC控制器2、方位驱动器3、俯仰驱动器8置于转台上并通过螺钉固定。24V蓄电池1分别与PLC控制器2、方位驱动器3、俯仰驱动器8、方位编码器7、俯仰编码器12以及运动指令输入设备13通过供电电缆18连接，PLC控制器2、方位驱动器3、俯仰驱动器8以及运动指令输入设备13通过CAN2.0B协议电缆14连接；PLC控制器2分别与方位编码器7、俯仰编码器12通过CANopen协议电缆15连接，方位驱动器3和方位伺服电机4通过方位驱动电缆16和方位反馈电缆19连接，俯仰驱动器8和俯仰伺服电机9通过俯仰驱动电缆17和俯仰反馈电缆20连接。   
一种基于CAN总线的单兵转台伺服控制***的实施步骤如下：打开24V蓄电池1电源开关，给PLC控制器2、方位驱动器3、俯仰驱动器8、方位编码器7、俯仰编码器12供24V直流电。上电后，方位编码器7和俯仰编码器12开始按照CANopen帧格式以f 1的频率发送当前转台的方位角度和俯仰角度到CANopen协议总线15上；PLC控制器2按照CAN2.0B帧格式发送初始化命令到CAN2.0B协议总线14上，方位驱动器3和俯仰驱动器8接收到初始化命令后进行初始化；PLC控制器2首先读取CANopen协议总线15上的方位角度和俯仰角度，然后检测是否有运动指令到来，当运动指令输入设备13将运动指令发送到CAN2.0B协议总线14上时，PLC控制器2读入运动指令。PLC控制器2将运动指令与当前方位角度、俯仰角度作差，得到位置误差指令，将此位置误差指令作为位置PI控制闭环的输入指令，经过PI运算，PLC控制器2输出速度指令到CAN2.0B协议总线14上，当方位驱动器3和俯仰驱动器8接收到速度指令后分别通过方位驱动电缆16和俯仰驱动电缆17输出电压信号给方位伺服电机4和俯仰伺服电机9，从而驱动方位伺服电机4和俯仰伺服电机9运动；运动过程中，方位驱动器3和俯仰驱动器8分别通过方位反馈电缆19和俯仰反馈电缆20读取方位伺服电机4和俯仰伺服电机9的转速反馈信息，将反馈转速与指令转速的差值作为方位驱动器3和俯仰驱动器8内部速度PI控制闭环的输入，进行速度PI调节。

Claims (1)

1.一种基于CAN总线的单兵转台伺服控制***，包括：PLC控制器（2）、方位驱动器（3）、方位伺服电机（4）、方位减速机（5）、方位编码器（7）、俯仰驱动器（8）、俯仰伺服电机（9）、俯仰减速机（10）和俯仰编码器（12），其特征在于还包括：24V蓄电池（1）、方位负载（6）、俯仰负载（11）、运动指令输入设备（13）、CAN2.0B协议总线（14）、CANopen协议总线（15）、方位驱动电缆（16）、俯仰驱动电缆（17）、供电电缆（18）、方位反馈电缆（19）和俯仰反馈电缆（20）；方位伺服电机（4）与方位减速机（5）通过螺钉连接，方位伺服电机（4）的输出轴与方位减速机（5）的输入轴通过平键连接，方位减速机（5）的输出轴与方位负载（6）通过平键连接，方位编码器（7）的输出轴与方位负载（6）通过平键连接并随方位负载（6）同步旋转；俯仰伺服电机（9）与俯仰减速机（10）通过螺钉连接，俯仰伺服电机（9）的输出轴与俯仰减速机（10）的输入轴通过平键连接，俯仰减速机（10）的输出轴与俯仰负载（11）通过平键连接，俯仰编码器（12）的输出轴与俯仰负载（11）通过平键连接并随俯仰负载（11）同步旋转；24V蓄电池（1）、PLC控制器（2）、方位驱动器（3）和俯仰驱动器（8）均置于转台上并通过螺钉固定；24V蓄电池（1）分别与PLC控制器（2）、方位驱动器（3）、俯仰驱动器（8）、方位编码器（7）、俯仰编码器（12）以及运动指令输入设备（13）通过供电电缆（18）连接，PLC控制器（2）分别与方位驱动器（3）、俯仰驱动器（8）以及运动指令输入设备（13）通过CAN2.0B协议电缆连接，PLC控制器（2）分别与方位编码器（7）和俯仰编码器（12）通过CANopen协议电缆连接，方位驱动器（3）与方位伺服电机（4）通过方位驱动电缆（16）和方位反馈电缆（19）连接；俯仰驱动器（8）与俯仰伺服电机（9）通过俯仰驱动电缆（17）和俯仰反馈电缆（20）连接；
打开24V蓄电池（1）电源开关，给PLC控制器（2）、方位驱动器（3）、俯仰驱动器（8）、方位编码器（7）、俯仰编码器（12）供24V直流电；上电后，方位编码器（7）和俯仰编码器（12）开始按照CANopen帧格式以f 1的频率发送当前转台的方位角度和俯仰角度到CANopen协议总线（15）上；PLC控制器（2）按照CAN2.0B帧格式发送初始化命令到CAN2.0B协议总线（14）上，方位驱动器（3）和俯仰驱动器（8）接收到初始化命令后进行初始化；PLC控制器（2）首先读取CANopen协议总线（15）上的方位角度和俯仰角度，然后检测是否有运动指令到来，当运动指令输入设备（13）将运动指令发送到CAN2.0B协议总线（14）上时，PLC控制器（2）读入运动指令；PLC控制器（2）将运动指令与当前方位角度、俯仰角度作差，得到位置误差指令，将此位置误差指令作为位置PI控制闭环的输入指令，经过PI运算，PLC控制器（2）输出速度指令到CAN2.0B协议总线（14）上，当方位驱动器（3）和俯仰驱动器（8）接收到速度指令后分别通过方位驱动电缆（16）和俯仰驱动电缆（17）输出电压信号给方位伺服电机（4）和俯仰伺服电机（9），从而驱动方位伺服电机（4）和俯仰伺服电机（9）运动；运动过程中，方位驱动器（3）和俯仰驱动器（8）分别通过方位反馈电缆（19）和俯仰反馈电缆（20）读取方位伺服电机（4）和俯仰伺服电机（9）的转速反馈信息，将反馈转速与指令转速的差值作为方位驱动器（3）和俯仰驱动器（8）内部速度PI控制闭环的输入，进行速度PI调节。
CN201410364569.6A 2014-07-29 2014-07-29 一种基于can总线的单兵转台伺服控制*** Pending CN104133414A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410364569.6A CN104133414A (zh) 2014-07-29 2014-07-29 一种基于can总线的单兵转台伺服控制***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410364569.6A CN104133414A (zh) 2014-07-29 2014-07-29 一种基于can总线的单兵转台伺服控制***

Publications (1)

Publication Number Publication Date
CN104133414A true CN104133414A (zh) 2014-11-05

Family

ID=51806134

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410364569.6A Pending CN104133414A (zh) 2014-07-29 2014-07-29 一种基于can总线的单兵转台伺服控制***

Country Status (1)

Country Link
CN (1) CN104133414A (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108332707A (zh) * 2017-12-28 2018-07-27 中国船舶重工集团公司第七0研究所 一种智能电子受信仪
CN109502485A (zh) * 2018-12-27 2019-03-22 三海洋重工有限公司 吊具驱动控制装置及电动吊具
CN113173500A (zh) * 2021-03-31 2021-07-27 江苏无线电厂有限公司 一种升降倒伏机构及其控制方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070256861A1 (en) * 2006-05-05 2007-11-08 Hulick Kent E Bit face orientation control in drilling operations
CN202580513U (zh) * 2012-04-13 2012-12-05 河北威赛特科技有限公司 超小型二维控制转台

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070256861A1 (en) * 2006-05-05 2007-11-08 Hulick Kent E Bit face orientation control in drilling operations
CN202580513U (zh) * 2012-04-13 2012-12-05 河北威赛特科技有限公司 超小型二维控制转台

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
王鹏: "《"动中通"天线稳定平台伺服控制***的研究与开发》", 《中国优秀硕士学位论文全文数据库信息科技辑》 *
董新利: "《"两轴稳定转台伺服控制***研究"》", 《中国优秀硕士学位论文全文数据库信息科技辑》 *
高嵩: "《基于CANopen协议的伺服控制器应用》", 《电子机械工程》 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108332707A (zh) * 2017-12-28 2018-07-27 中国船舶重工集团公司第七0研究所 一种智能电子受信仪
CN109502485A (zh) * 2018-12-27 2019-03-22 三海洋重工有限公司 吊具驱动控制装置及电动吊具
CN109502485B (zh) * 2018-12-27 2024-07-05 三一海洋重工有限公司 吊具驱动控制装置及电动吊具
CN113173500A (zh) * 2021-03-31 2021-07-27 江苏无线电厂有限公司 一种升降倒伏机构及其控制方法

Similar Documents

Publication Publication Date Title
CN201532580U (zh) 一种水下滑翔机用低功耗控制***
CN102079373A (zh) 一种水下滑翔机用低功耗控制***及其控制方法
CN104082049A (zh) 一种全自动嫁接机
CN103607149B (zh) 一种超声电机舵伺服***及其控制方法
CN104133414A (zh) 一种基于can总线的单兵转台伺服控制***
EP2362536A3 (en) Motor control method and motor control system
WO2019024570A1 (zh) 一种数字舵机及其控制方法
CN205334227U (zh) 一种舵轮agv控制装置、控制***
CN105897068A (zh) 一种硬脆材料多线切方机用双电机力矩同步控制***
CN102664569A (zh) 一种基于滑模变结构的永磁同步直线电机控制方法及装置
CN203265879U (zh) 一种四轴超声波焊接机用焊接单元
CN206807337U (zh) 车用驱动电机控制装置及***
CN1858986A (zh) 一种步进电机的控制方法及控制装置
CN102420557B (zh) 一种基于四象限运行的螺旋桨模拟装置及其模拟方法
CN202583811U (zh) 一种基于EtherCAT总线技术的多轴同步运动控制***
CN203745852U (zh) 一种立体存储定位装置
CN204980410U (zh) 一种码垛机
CN203812050U (zh) 一种能够精确追踪光源中心的控制***
CN203259887U (zh) 一种太阳跟踪装置
CN201976054U (zh) 方波和正弦波电机控制***
CN202217162U (zh) 伺服变位机电控***
CN204474160U (zh) 塔机回转的涡流控制***
CN105071739B (zh) 一种直线电机的控制***及其控制方法
CN102684584A (zh) 一种基于以太网的远程步进电机控制***
CN207834444U (zh) 一种锂离子电池极片剪切机具有的新型极片收卷设备

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
WD01 Invention patent application deemed withdrawn after publication
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20141105