CN203786565U - 一种基于位置环控制的电动舵机系统 - Google Patents
一种基于位置环控制的电动舵机系统 Download PDFInfo
- Publication number
- CN203786565U CN203786565U CN201320881389.6U CN201320881389U CN203786565U CN 203786565 U CN203786565 U CN 203786565U CN 201320881389 U CN201320881389 U CN 201320881389U CN 203786565 U CN203786565 U CN 203786565U
- Authority
- CN
- China
- Prior art keywords
- circuit
- signal
- control
- rudder
- power
- 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.)
- Expired - Lifetime
Links
- 238000002955 isolation Methods 0.000 claims description 11
- 238000000034 method Methods 0.000 claims description 8
- 238000012545 processing Methods 0.000 claims description 7
- 230000005520 electrodynamics Effects 0.000 claims description 6
- 230000002708 enhancing effect Effects 0.000 claims description 4
- 230000009467 reduction Effects 0.000 claims description 4
- 238000005070 sampling Methods 0.000 claims description 4
- 230000005669 field effect Effects 0.000 claims description 3
- 238000011144 upstream manufacturing Methods 0.000 claims description 3
- 238000013461 design Methods 0.000 abstract description 9
- 230000003321 amplification Effects 0.000 abstract description 3
- 230000010354 integration Effects 0.000 abstract description 3
- 230000007246 mechanism Effects 0.000 abstract description 3
- 238000003199 nucleic acid amplification method Methods 0.000 abstract description 3
- 230000004069 differentiation Effects 0.000 abstract 1
- 230000004044 response Effects 0.000 description 6
- 239000003990 capacitor Substances 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 5
- 230000008569 process Effects 0.000 description 4
- 239000004065 semiconductor Substances 0.000 description 4
- 238000001914 filtration Methods 0.000 description 3
- 230000003068 static effect Effects 0.000 description 3
- 238000012360 testing method Methods 0.000 description 3
- 239000011324 bead Substances 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000010363 phase shift Effects 0.000 description 2
- 230000005622 photoelectricity Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 230000008023 solidification Effects 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
Abstract
本实用新型涉及一种电动舵机系统，特别是一种基于位置环控制的电动舵机系统，通过硬件与软件相结合的方式实现。其中硬件设计中电源电路采用带隔离输出的DC/DC电源，将弹上电源进行变换后给各单元电路供电；控制电路采用TMS320F2812作为主控单元，采集舵控信号和舵偏角反馈信号，并对其误差进行综合与放大，通过模糊PID算法计算实际输出的PWM信号，并提供给驱动电路；驱动电路将该信号进行功率放大后驱动舵机执行机构转动，从而实现电动舵机系统的位置环闭环控制。
Description
技术领域
本实用新型涉及一种舵机系统，特别是涉及一种电动舵机控制系统。
背景技术
舵机控制系统作为弹上执行机构，其性能的好坏直接影响到整弹控制系统的控制品质。
传统的导弹舵机，一般采用模拟式、液压或气压伺服系统，但其结构复杂，加工精度高，质量大，成本高，技术难度大。
随着数字信号处理技术的迅猛发展，DSP、ARM及CPLD等应用于电动舵机控制系统，它可直接产生高精度PWM信号控制电机，具有强大的数据处理能力，有效抑制了转矩纹波，减小了电机振动、延长了电机寿命，同时可以根据系统特性实时调整动态参数，能够克服传统导弹舵机面临的技术困难，现已广泛应用于防空武器、导弹及军舰上。
发明内容
本实用新型目的是提供一种基于位置环控制的电动舵机系统,以克服现有传统导弹舵机面临的技术困难。
一种基于位置环控制的电动舵机系统,包括：电源电路、DSP控制电路、光电隔离电路、驱动电路、伺服电机、减速器、反馈单元和 执行机构；电源电路选用双路带隔离输出的DC/DC变换器，将驱动部分和控制部分电源完全隔离，在DC/DC输入前端加EMI电源滤波器以衰减电源线上的干扰，在电源的进入端加TVS管以有效防止瞬时过压脉冲；DSP控制电路选用TMS320F2812作为主控单元，片内具有两个增强的事件管理器模块EVA及EVB，每个事件管理模块包括通用定时器、全比较/PWM单元、捕获单元，利用定时器和比较单元产生一定频率及占空比的PWM信号，片内16通道12位高速A/D采集模块用于舵控信号及舵偏角反馈信号的采集及处理；光电隔离电路选用电磁隔离芯片AD1200BR；驱动电路选用驱动芯片IR2108直接驱动场效应管，其内部采用自举技术设计出悬浮电源。
为了提高系统的运行精度、提升系统稳定性、增强系统的抗干扰能力、节约成本，本实用新型提供了一种基于位置环控制的电动舵机系统，其以DSP作为核心控制器，采用C语言编程实现模糊PID控制算法，实现对电动舵机位置环的数字化控制。
本实用新型电动舵机从弹上飞行控制器接受舵控信号操作舵面转动，使导弹按照预期弹道攻击目标。其主要功能包括：
a)舵机系统上电，接受飞行控制器舵控信号；
b)采集舵机执行机构反馈单元电位计电压(舵偏信号)，计算舵面实际舵偏角度；
c)计算舵控信号与舵偏信号误差，并进行处理及综合放大后驱动舵机执行机构跟随舵控信号。
舵机控制系统硬件部分包括电源电路、DSP2812核心控制器电路、光电隔离电路、驱动电路的设计。软件部分采用C语言和汇编语言混合编程实现，舵机控制系统软件设计包括以下四个部分：
(1)对舵控信号和舵偏角反馈信号进行采集；
(2)对采集的信号进行数字滤波；
(3)误差计算和控制算法的实现；
(4)PWM信号占空比计算。
本实用新型的有益效果是采用数字式舵机代替了模拟式舵机大部分模拟器件，减少了元器件的种类和数量，简化了电路设计，提高了系统可靠性；用程序实现系统中控制部分的频率、死区、放大倍数、校正环节等重要参数，便于调整和参数优化；采用数字信号代替模拟信号，克服了模拟器件固有的参数分散、温度漂移大等缺点，提高了抗干扰能力，系统响应速度快，成本低，易于实现。
附图说明
图1是电动舵机系统组成框图；
图2是系统总体方案设计框图；
图3是电源电路原理图；
图4是光电隔离及单桥臂驱动输出电路原理图
图5是系统程序任务框图；
图6是系统定时中断子程序流程图；
图7是舵机跟随±20°方波信号的响应曲线；
图8是舵机跟随峰值3°，频率3Hz正弦信号的响应曲线。
具体实施方式：
舵机系统由控制电路、驱动电路、伺服电机、减速传动机构和反馈单元五大部分组成，见附图1。
舵机系统从弹上飞行控制器接受一定大小和极性的舵控信号ui，控制舵面转动。实际舵偏角δ经反馈单元形成舵偏信号uf，与舵控信号ui产生误差信号uc，控制器根据控制算法对误差信号uc进行处理并产生驱动信号，该信号经过驱动电路进行功率放大后，驱动伺服电机转动，伺服电机的力矩通过减速传动机构放大，带动舵面向所要求的角度偏转，从而实现电动舵机位置环的闭环控制。
当误差uc为正时，加在伺服电机上的直流平均电压为正，舵面向正方向转动；误差uc为负时，加在伺服电机上的直流平均电压为负，舵面向负方向转动；当舵面偏转到要求的角度时，误差信号uc为零，加在伺服电机上的直流平均电压为零，舵面失去驱动力矩停止转动。
舵机控制系统硬件包括电源电路、控制电路、光电隔离电路、驱动电路四个部分。电源电路主要是对弹上提供电源进行电源变换后给舵机控制系统各部分电路供电；DSP2812控制电路是系统进行信号综合、处理和分配的核心，主要是采集舵控信号和舵偏角反馈信号，并对其误差进行综合与放大，通过控制算法计算控制电压，再根据控制电压改变PWM信号的占空比输出实际PWM控制信号；光电隔离电路主要实现控制电路和驱动电路的电气隔离；驱动电路主要是为了增 强控制信号的驱动能力，它是将多个场效应管(MOSFET)集成在一起，形成驱动电机所需的H桥逆变电路，对PWM信号进行功率放大后驱动舵机执行机构转动。系统总体方案设计框图见附图2。
系统电源电路选用双路隔离输出的DC/DC变换器，输入电压范围为16VDC～50VDC，输出为15V/1A和5V/1A两路电源，且完全隔离。内部各电源都加去耦电容滤波，在电源给各芯片供电时，加磁珠来衰减电磁干扰信号。主要信号线之间加磁珠来衰减干扰信号。用隔离DC/DC将驱动部分地和控制部分地完全隔离。在DC/DC输入前端加EMI电源滤波器，衰减电源线上的干扰信号，滤波器的额定电压达到50VDC。为了防止瞬时过压脉冲，电源的进入端加TVS管，从而有效地保护电子线路中的精密元器件免受损坏。电源电路原理图见附图3。
控制电路采用TI公司的TMS320F2812作为主控单元，它是一款实时处理能力强的高性能数字信号处理器，能够满足舵控系统实时性要求高的特点。TMS320F2812最高工作时钟频率为150MHz，指令周期6.67ns，可以满足本系统实时性要求高的特点；片内集成128k×16位的Flash存储器，可将程序固化在片内Flash上；具有两个增强的事件管理器模块(EVA、EVB)，提供了一整套用于电机数字化控制的功能和特性，每个事件管理模块包括通用定时器、全比较/PWM单元、捕获单元，利用定时器和比较单元产生一定频率及占空比的PWM信号提供给驱动电路，定时器及捕获单元共同完成弹旋(脉冲)信号的采集及处理；16通道12位高速A/D采集模块用于舵控信 号及舵偏角反馈信号的采集及处理。
光电隔离电路能有效消除环路引起的共阻抗耦合干扰，实现DSP数字电路与大电压、大电流的驱动电路之间的地线隔离，使控制部分免受驱动部分的干扰。
驱动电路的驱动芯片IR2108是美国国际整流器公司(InternationalRectifierCompany)的产品，可驱动MOSFET或IGBT。该芯片的应用简化了驱动电路的设计。IR2108内部采用自举技术设计出悬浮电源，实现一相两个N沟道逆变桥输出电路的控制。光电隔离及驱动电路原理图见附图4。
其中IR2108的2脚HIN和3脚LIN分别为高侧MOS管和低侧MOS管的驱动控制端，C15为自举电容，D1为充电二极管。当HIN、LIN同时为低电平时，输出LO比低电位高15V，MOS管Q2导通；反之当HIN、LIN同时为高电平时，开始HO比VS高出15V(这个电压是对电容充电的结果)，MOS管Q1导通，随着时间的延续，电容通过电阻R6、R8放电，导致电压不断下降，Q1导通时间与电容C15容量有关，当脉宽调制频率在5kHz以上时，电容C15选用0.1μF即可。因此，使用该芯片可以有效防止上下输出桥臂短路。
系统软件采用模块化设计，使用C语言和汇编语言混合编程实现，按照系统功能任务，可以把总任务分成几个模块来实现。系统程序任务框图见附图5。
其中DSP主程序完成上电初始化(包括系统初始化、PWM单元初始化、模数转换模块)，初始化完成后，打开中断，采用循环方式 等待A/D采集中断和定时中断的到来。A/D转换单元完成舵控信号和舵偏角反馈信号的采集后向CPU发送中断信号，CPU响应中断读取舵控信号和舵偏角反馈信号对应的数字量。在定时中断程序中，将采集到的信号进行数字滤波后，计算舵偏角反馈信号与舵控信号的误差量，通过控制算法计算PWM输出占空比。中断子程序流程图见附图6。
系统采用PID算法作为基础控制算法，PID算法数学表达式为：
其中E(k)、和C(k)分别为其输入变量误差、误差和与误差变化率，KP、KI及KD分别为比例增益系数、积分增益系数和微分增益系数。在这三个控制参数中，KP的控制效果是减小响应曲线的上升时间及静态误差；KI的控制效果是消除静态误差，但会延长过渡过程时间，增大超调量；KD的控制效果是增强系统的稳定性，减少过渡过程时间，降低超调量。从舵机控制要求的快速性和跟随精度来说，增大KP和KI有利于减小系统静态误差，但是会降低系统的稳定性。因此，在实际的系统联调过程中，本实用新型采用基础PID控制结合模糊控制算法在线调整控制参数，以实现最优控制效果。
根据以上原理，分别给舵机控制系统输入±20°方波信号和峰值3°，频率3Hz正弦信号，以此检测舵机跟随控制信号的控制效果。
对该系统进行联调测试，通过对控制算法和PID参数进行调节与优化，本实用新型取得了较好的控制效果。测试结果见附图7和附图 8。由图可知舵机在跟随±20°方波信号时,系统超调量为1.5％，稳态误差为0.05°；在跟随峰值3°，频率3Hz正弦信号时，系统峰值为2.83°，相移为31°。因此，该舵机控制系统具有良好的动态跟踪特性，系统响应速度快、超调量小、相移小，能够满足控制要求，在实际工程中有较高的应用价值。
Claims (1)
1.一种基于位置环控制的电动舵机系统,其特征在于包括：电源电路、DSP控制电路、光电隔离电路、驱动电路、伺服电机、减速器、反馈单元和执行机构；电源电路选用双路带隔离输出的DC/DC变换器，将驱动部分和控制部分电源完全隔离，在DC/DC输入前端加以衰减电源线上干扰的EMI电源滤波器，在电源的进入端加以有效防止瞬时过压脉冲的TVS管；DSP控制电路选用TMS320F2812作为主控单元，片内具有两个增强的事件管理器模块EVA及EVB，每个事件管理模块包括通用定时器、全比较/PWM单元、捕获单元，利用定时器和比较单元产生一定频率及占空比的PWM信号，片内16通道12位高速A/D采集模块用于舵控信号及舵偏角反馈信号的采集及处理；光电隔离电路选用电磁隔离芯片AD1200BR；驱动电路选用驱动芯片IR2108直接驱动场效应管，其内部采用自举技术设计有悬浮电源。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201320881389.6U CN203786565U (zh) | 2013-12-27 | 2013-12-27 | 一种基于位置环控制的电动舵机系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201320881389.6U CN203786565U (zh) | 2013-12-27 | 2013-12-27 | 一种基于位置环控制的电动舵机系统 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN203786565U true CN203786565U (zh) | 2014-08-20 |
Family
ID=51322729
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201320881389.6U Expired - Lifetime CN203786565U (zh) | 2013-12-27 | 2013-12-27 | 一种基于位置环控制的电动舵机系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN203786565U (zh) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104536333A (zh) * | 2014-11-21 | 2015-04-22 | 中国航天科技集团公司第九研究院第七七一研究所 | 一种小型电动舵机的控制系统及控制方法 |
| CN104679009A (zh) * | 2014-08-29 | 2015-06-03 | 北京精密机电控制设备研究所 | 一种水下装备用控制驱动器、水下装备及其驱动方法 |
| CN107005183A (zh) * | 2016-08-05 | 2017-08-01 | 深圳市创客工场科技有限公司 | 一种舵机 |
| CN107703979A (zh) * | 2017-09-21 | 2018-02-16 | 中国科学院长春光学精密机械与物理研究所 | 舵机伺服系统的尖峰电流抑制方法及装置 |
| CN114337405A (zh) * | 2021-12-28 | 2022-04-12 | 湖北三江航天红峰控制有限公司 | 一种舵机驱动电路和方法 |
-
2013
- 2013-12-27 CN CN201320881389.6U patent/CN203786565U/zh not_active Expired - Lifetime
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104679009A (zh) * | 2014-08-29 | 2015-06-03 | 北京精密机电控制设备研究所 | 一种水下装备用控制驱动器、水下装备及其驱动方法 |
| CN104536333A (zh) * | 2014-11-21 | 2015-04-22 | 中国航天科技集团公司第九研究院第七七一研究所 | 一种小型电动舵机的控制系统及控制方法 |
| CN107005183A (zh) * | 2016-08-05 | 2017-08-01 | 深圳市创客工场科技有限公司 | 一种舵机 |
| WO2018023725A1 (zh) * | 2016-08-05 | 2018-02-08 | 深圳市创客工场科技有限公司 | 一种舵机 |
| CN107703979A (zh) * | 2017-09-21 | 2018-02-16 | 中国科学院长春光学精密机械与物理研究所 | 舵机伺服系统的尖峰电流抑制方法及装置 |
| CN114337405A (zh) * | 2021-12-28 | 2022-04-12 | 湖北三江航天红峰控制有限公司 | 一种舵机驱动电路和方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN103699134A (zh) | 一种基于位置环控制的电动舵机系统 | |
| CN203786565U (zh) | 一种基于位置环控制的电动舵机系统 | |
| CN103231798B (zh) | 一种利用数字电动舵机控制装置的控制方法 | |
| CN102301582B (zh) | 阀控制装置 | |
| CN103213666B (zh) | 一种基于位置环换向的电动舵机装置和控制方法 | |
| CN100420145C (zh) | 一种集成磁悬浮飞轮直流无刷电动机控制系统 | |
| CN102556152B (zh) | 一种全硬件伺服助力转向控制器 | |
| CN101741312A (zh) | 伺服电机驱动系统的控制方法 | |
| CN103303454A (zh) | 一种基于速度环换向的电动舵机装置及其控制方法 | |
| CN105783612A (zh) | 一种通用小型化数字电动舵机控制器及其控制方法 | |
| CN101697465A (zh) | 一种交流伺服系统双机电消隙控制装置 | |
| CN202957785U (zh) | 一种舵机数字控制器 | |
| CN111756286B (zh) | 一种高性能鲁棒永磁同步轮毂电机复合控制器 | |
| CN104749997A (zh) | 用于激光跟踪仪精密伺服系统的驱动控制电路 | |
| CN103560039B (zh) | 一种高压断路器永磁凸极电机操动机构及控制方法 | |
| CN103607149B (zh) | 一种超声电机舵伺服系统及其控制方法 | |
| CN105223870A (zh) | 一种基于dsp与cpld的电动舵机控制系统 | |
| CN105093927B (zh) | 电动舵机死区换向替代补偿方法 | |
| CN103984327B (zh) | 一种基于模糊控制的小型数字舵机系统 | |
| CN112650112A (zh) | 一种舵机控制方法 | |
| CN105680734A (zh) | 一种双电机同步驱动系统和算法 | |
| CN116317748B (zh) | 基于神经元比例积分-模糊积分算法的双闭环bldc控制器 | |
| CN108923711A (zh) | 一种伺服系统零点校对的绝对值编码器调零方法 | |
| CN109861618B (zh) | 混合动力汽车用bsg交流电机抗干扰复合控制器的构造方法 | |
| CN109687810B (zh) | 一种纯电动物流车防止电机超速的转速控制方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| C41 | Transfer of patent application or patent right or utility model | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20161010 Address after: 430056 hi tech park, Wuhan economic and Technological Development Zone, Hubei Patentee after: Aerospace Times Electronic Technology Co.,Ltd. Address before: Baoji City, Shaanxi Province, 721006 West Road Weibin District No. 43 Patentee before: SHAANXI SPACEFLIGHT NAVIGATION EQUIPMENT CO.,LTD. |
|
| TR01 | Transfer of patent right | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20171221 Address after: 721006 Baoji hi tech Development Zone, new town, science and technology, Shaanxi Patentee after: SHAANXI AEROSPACE TIMES NAVIGATION EQUIPMENT Co.,Ltd. Address before: 430056 hi tech park, Wuhan economic and Technological Development Zone, Hubei Patentee before: Aerospace Times Electronic Technology Co.,Ltd. |
|
| CX01 | Expiry of patent term | ||
| CX01 | Expiry of patent term |
Granted publication date: 20140820 |