CN103213673B - 一种用于双y型无刷直流电动舵机的控制方法和驱动装置 - Google Patents
一种用于双y型无刷直流电动舵机的控制方法和驱动装置 Download PDFInfo
- Publication number
- CN103213673B CN103213673B CN201310163413.7A CN201310163413A CN103213673B CN 103213673 B CN103213673 B CN 103213673B CN 201310163413 A CN201310163413 A CN 201310163413A CN 103213673 B CN103213673 B CN 103213673B
- Authority
- CN
- China
- Prior art keywords
- msub
- mover
- control surface
- current
- mrow
- 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 - Fee Related
Links
- 208000026817 47,XYY syndrome Diseases 0.000 title claims abstract description 18
- 238000000034 method Methods 0.000 title claims abstract description 12
- 238000004804 winding Methods 0.000 claims abstract description 29
- 230000003750 conditioning effect Effects 0.000 claims description 14
- 230000005540 biological transmission Effects 0.000 claims description 8
- 238000004891 communication Methods 0.000 claims description 7
- 238000002955 isolation Methods 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 3
- 238000012544 monitoring process Methods 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 238000011217 control strategy Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Landscapes
- Control Of Motors That Do Not Use Commutators (AREA)
- Control Of Direct Current Motors (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明提供了一种用于双Y型无刷直流电动舵机的控制方法和驱动装置,舵机驱动控制器接收舵面位置给定信号以及舵面位置反馈信号,经过滑模控制方法解算,驱动双Y型绕组无刷直流电机工作,力矩通过传动齿轮组施加在受控舵面,使受控舵面按照给定的舵面位置信号进行动作。本发明提出了一种滑模均流控制策略,平衡电机两套绕组电流,解决力纷争问题,同时提高舵系统的可靠性。
Description
技术领域
本发明涉及一种用于双Y型无刷直流电动舵机的控制方法和驱动装置。
背景技术
无刷直流电动舵机具有体积小、控制精度高的特点,在飞行器舵机系统中得到了广泛的应用。目前,舵机余度控制系统发展迅速,目前的成果有:公开号为CN101799689A的专利《双余度舵机控制器》采用双余度设计,但仅对功率驱动电路进行了双余度设计,出力电机仍为单余度电机,其系统可靠性有待提高;公开号为CN202632110U的专利《一种双余度舵机系统》也采用双余度设计,但是,其更侧重对系统的故障诊断与隔离,对于电机控制方法,依然采用经典的PID控制,控制精度不高。
发明内容
为了克服现有技术的不足,本发明以冗余无刷直流电机为控制对象,提供了一种滑模均流控制策略,解决了两套绕组力纷争问题,提高控制精度。
本发明解决其技术问题所采用的技术方案过程如下:
第一步,控制器分别采集电机转速ωr、电机绕组1电流反馈信号i1及电机绕组2电流反馈信号i2,转至第二步。
第二步,经速度观测器:
得电机转速微分和转矩观测值微分其中,CT1为电机绕组1转矩常数,CT2为电机绕组2转矩常数,J为电机转动惯量,为负载力矩观测值,为电机转速观测值,c1为观测器系数(0<c1<100000),c2为观测器系数(-50000<c1<0)。转至第三步
第三步,计算观测的电机位置转至第四步。
第四步,控制器接收给定舵面位置θgv;转至第五步。
第五步,计算舵面位置误差转至第六步。
第六步,建立滑模线其中,为对舵面位置误差的e一次微分;c为误差系数,其取值范围在此设定为0<c<10;转至第七步。
第七步,采集电机角速度ω,计算速度给定ωgv,其中:
式中:J为负载转动惯量,为对给定舵面位置的一次微分,为给定舵面位置的二次微分,B为粘滞系数,TL为负载转矩,KT为绕组平均转矩系数,ξ>0,k>0;转至第八步。
第八步,计算速度误差信号eω=ωgv-ω;转至第九步。
第九步,进行速度环PID控制,PID输出作为电流环给定;转至第十步。
第十步,计算均流电流给定其中:
第十一步,计算电流误差信号及转至第十二步。
第十二步,进行均流环PID控制,驱动双余度无刷直流电机工作;转至第一步。
本发明还提供了如下的驱动装置:包括舵机驱动控制器部分,双Y型绕组无刷直流电机,传动齿轮组和受控舵面部分。驱动控制器部分接收舵面位置给定信号以及舵面位置反馈信号,经过驱动控制器算法控制,驱动双Y型绕组无刷直流电机工作,力矩通过传动齿轮组施加在受控舵面,使舵面按照给定的舵面位置信号进行动作。
其中,所述的舵机驱动控制器包括控制器DSP单元、数字隔离电路单元、驱动电路单元、主功率电路单元、电流采集电路单元、速度信号采集单元、位置传感器、位置给定信号调理电路单元、位置反馈信号调理电路单元和RS-422通信单元,舵面位置给定信号和舵面位置反馈信号分别经过位置给定信号调理电路单元和位置反馈信号调理电路单元输入控制器DSP单元,进行模数转换,控制器DSP单元接收到舵面位置指令后,通过滑模控制算法,输出驱动信号,驱动信号经数字隔离电路单元和驱动电路单元,驱动主功率电路,控制双Y型绕组无刷直流电机工作;双Y型绕组无刷直流电机的母线电流经电流采集电路单元采样,实现电流环闭环控制;速度信号采集单元采集电机的当前转速,反馈回控制器DSP单元,用以实现转速的闭环控制;与齿轮组相连的位置传感器实时反馈舵面的当前位置,传给控制器DSP单元,完成舵面位置闭环控制;舵面位置实际测量值经RS-422通信单元传给上位机进行监测。
本发明的有益效果是:以双余度无刷直流电动机伺服系统为研究对象,提出了一种滑模均流控制策略,平衡电机两套绕组电流,解决力纷争问题,同时提高舵系统的可靠性。
附图说明
图1是本发明的控制方法流程图;
图2是本发明的驱动装置原理框图;
图中,1—舵机控制器,2—双Y型绕组无刷直流电机,3—传动齿轮组,4—受控舵面,5—RS-422通信单元,6—给定信号调理电路单元,7—DSP控制单元,8—数字隔离电路单元,9—驱动单元,10—主功率电路单元,11—电流传感器,12—反馈信号调理电路,13—舵面位置传感器,14—速度信号采集单元。
具体实施方式
本发明提供的控制方法为:
第一步,控制器分别采集电机转速ωr,电机绕组1电流反馈信号i1及电机绕组2电流反馈信号i2,转至第二步。
第二步,经速度观测器:
得电机转速微分和转矩观测值微分其中,CT1为电机绕组1转矩常数,CT2为电机绕组2转矩常数,J为电机转动惯量,为负载力矩观测值,为电机转速观测值,c1为观测器系数(0<c1<100000),c2为观测器系数(-50000<c1<0)。转至第三步
第三步,计算观测的电机位置转至第四步。
第四步,控制器接收给定舵面位置θgv;转至第五步。
第五步,计算舵面位置误差转至第六步。
第六步,建立滑模线其中,为对舵面位置误差的e一次微分;c为误差系数,其取值范围在此设定为0<c<10;转至第七步。
第七步,采集电机角速度ω,计算速度给定ωgv,其中:
式中:J为负载转动惯量,为对给定舵面位置的一次微分,为给定舵面位置的二次微分,B为粘滞系数,TL为负载转矩,KT为绕组平均转矩系数,ξ>0,k>0;转至第八步。
第八步,计算速度误差信号eω=ωgv-ω;转至第九步。
第九步,进行速度环PID控制,PID输出作为电流环给定;转至第十步。
第十步,计算均流电流给定其中:
第十一步,计算电流误差信号转至第十二步。
第十二步,进行均流环PID控制,驱动双余度无刷直流电机工作;转至第一步。
本发明所述的驱动装置包括舵机控制器1,双Y型绕组无刷直流电机2,传动齿轮组3,受控舵面4。舵机控制器1接收舵面位置给定信号以及舵面位置反馈信号,经过控制器算法控制,驱动双Y型绕组无刷直流电机2工作,力矩通过传动齿轮3组施加在受控舵面4,使受控舵面4按照给定的舵面位置信号进行动作。
其中,舵机控制器部分包括:5—RS-422通信单元,6—给定信号调理电路单元,7—DSP控制单元,8—数字隔离电路单元,9—驱动电路单元,10—主功率电路单元,11—电流传感器,12—反馈信号调理电路,13—舵面位置传感器。舵面位置给定信号和舵面位置反馈信号分别经过给定信号调理电路6和反馈信号调理电12,DSP控制单元7,进行转换,通过控制算法控制,输出驱动信号,驱动信号经数字隔离8、驱动电路9,驱动主功率电路10的功率管,控制双Y型绕组无刷直流电动机2工作。力矩通过传动齿轮3组施加在受控舵面4,使受控舵面4按照给定的舵面位置信号进行动作。无刷直流电机的母线电流经电流传感器11采样,送入DSP控制单元7,实现电流环闭环控制。速度信号采集单元14采集电机的当前转速,反馈回控制器DSP单元,用以实现转速的闭环控制。与传动齿轮组3的相连的位置传感器13实时反馈受控舵面4的当前位置,传给DSP控制单元7,完成舵面位置闭环控制。舵面位置实际测量值经RS-422通信单元5传给上位机进行监测。
Claims (3)
1.一种用于双Y型无刷直流电动舵机的控制方法,其特征在于包括下述步骤:
第一步,控制器分别采集电机转速ωr、电机绕组1电流反馈信号i1及电机绕组2电流反馈信号i2;
第二步,经速度观测器:
得电机转速微分和转矩观测值微分其中,CT1为电机绕组1转矩常数,CT2为电机绕组2转矩常数,J为电机转动惯量,为负载力矩观测值,为电机转速观测值,c1为观测器系数,0<c1<100000,c2为观测器系数,-50000<c2<0;
第三步,计算观测的电机位置
第四步,控制器接收给定舵面位置θgv;
第五步,计算舵面位置误差
第六步,建立滑模线其中,为对舵面位置误差的e一次微分;c为误差系数,0<c<10;
第七步,采集电机角速度ω,计算速度给定ωgv,其中:
式中:J为负载转动惯量,为对给定舵面位置的一次微分,为给定舵面位置的二次微分,B为粘滞系数,TL为负载转矩,KT为绕组平均转矩系数,ξ>0,k>0;
第八步,计算速度误差信号eω=ωgv-ω;
第九步,进行速度环PID控制,PID输出作为电流环给定
第十步,计算均流电流给定
第十一步,计算电流误差信号 及
第十二步,进行均流环PID控制,驱动双余度无刷直流电机工作;转至第一步。
2.一种利用权利要求1所述方法用于双Y型无刷直流电动舵机的驱动装置,包括舵机驱动控制器、双Y型绕组无刷直流电机、传动齿轮组和受控舵面部分,其特征在于:舵机驱动控制器接收舵面位置给定信号以及舵面位置反馈信号,经过上述控制方法解算,驱动双Y型绕组无刷直流电机工作,力矩通过传动齿轮组施加在受控舵面,使受控舵面按照给定的舵面位置信号进行动作。
3.根据权利要求2所述的用于双Y型无刷直流电动舵机的驱动装置,其特征在于:所述的舵机驱动控制器包括控制器DSP单元、数字隔离电路单元、驱动电路单元、主功率电路单元、电流采集电路单元、速度信号采集单元、位置传感器、位置给定信号调理电路单元、位置反馈信号调理电路单元和RS-422通信单元,舵面位置给定信号和舵面位置反馈信号分别经过位置给定信号调理电路单元和位置反馈信号调理电路单元输入控制器DSP单元,进行模数转换,控制器DSP单元接收到舵面位置指令后,通过滑模控制算法,输出驱动信号,驱动信号经数字隔离电路单元和驱动电路单元,驱动主功率电路,控制双Y型绕组无刷直流电机工作;双Y型绕组无刷直流电机的母线电流经电流采集电路单元采样,实现电流环闭环控制;速度信号采集单元采集电机的当前转速,反馈回控制器DSP单元,用以实现转速的闭环控制;与齿轮组相连的位置传感器实时反馈舵面的当前位置,传给控制器DSP单元,完成舵面位置闭环控制;舵面位置实际测量值经RS-422通信单元传给上位机进行监测。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310163413.7A CN103213673B (zh) | 2013-05-06 | 2013-05-06 | 一种用于双y型无刷直流电动舵机的控制方法和驱动装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310163413.7A CN103213673B (zh) | 2013-05-06 | 2013-05-06 | 一种用于双y型无刷直流电动舵机的控制方法和驱动装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103213673A CN103213673A (zh) | 2013-07-24 |
CN103213673B true CN103213673B (zh) | 2015-07-15 |
Family
ID=48811927
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310163413.7A Expired - Fee Related CN103213673B (zh) | 2013-05-06 | 2013-05-06 | 一种用于双y型无刷直流电动舵机的控制方法和驱动装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103213673B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105607526A (zh) * | 2014-11-14 | 2016-05-25 | 中国航空工业第六一八研究所 | 一种用于电动舵机的高精度小型伺服控制器 |
CN104779875A (zh) * | 2015-05-04 | 2015-07-15 | 奇瑞汽车股份有限公司 | 一种直流伺服电机闭环控制系统 |
CN104991442B (zh) * | 2015-06-24 | 2018-03-13 | 北京工业大学 | 基于无刷电机驱动的大力矩舵机伺服系统 |
CN109000522B (zh) * | 2018-08-16 | 2020-08-28 | 上海航天控制技术研究所 | 差动式双余度舵机的安全优化控制方法 |
CN113291464B (zh) * | 2021-04-20 | 2022-12-06 | 中国直升机设计研究所 | 一种直升机振动主动控制系统作动器的双电机控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6386485B1 (en) * | 1997-12-30 | 2002-05-14 | Saab Ab | Arrangement and method for regulating the steering force in a mechanical steering system for an aircraft |
JP4086199B2 (ja) * | 2005-05-24 | 2008-05-14 | 独立行政法人 宇宙航空研究開発機構 | 操縦システム |
JP2011235711A (ja) * | 2010-05-07 | 2011-11-24 | Toyota Motor Corp | 操舵補助装置 |
CN102706271A (zh) * | 2012-05-31 | 2012-10-03 | 西北工业大学 | 一种舵机舵面角位置传感器冗余装置和控制方法 |
CN102700706A (zh) * | 2012-05-31 | 2012-10-03 | 西北工业大学 | 一种双余度舵机系统和控制方法 |
-
2013
- 2013-05-06 CN CN201310163413.7A patent/CN103213673B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6386485B1 (en) * | 1997-12-30 | 2002-05-14 | Saab Ab | Arrangement and method for regulating the steering force in a mechanical steering system for an aircraft |
JP4086199B2 (ja) * | 2005-05-24 | 2008-05-14 | 独立行政法人 宇宙航空研究開発機構 | 操縦システム |
JP2011235711A (ja) * | 2010-05-07 | 2011-11-24 | Toyota Motor Corp | 操舵補助装置 |
CN102706271A (zh) * | 2012-05-31 | 2012-10-03 | 西北工业大学 | 一种舵机舵面角位置传感器冗余装置和控制方法 |
CN102700706A (zh) * | 2012-05-31 | 2012-10-03 | 西北工业大学 | 一种双余度舵机系统和控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103213673A (zh) | 2013-07-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103213673B (zh) | 一种用于双y型无刷直流电动舵机的控制方法和驱动装置 | |
Belousov et al. | An electric traction drive for electric vehicles | |
CN102497157B (zh) | 绕组分段直线电机的无传感器控制装置及控制方法 | |
US20160368496A1 (en) | Vehicle | |
WO2008146617A1 (ja) | 動力出力装置、それを備えたハイブリッド自動車、および動力出力装置の制御方法 | |
CN107395081A (zh) | 一种重载机车滑模极值搜索最优粘着控制系统及方法 | |
CN103279128A (zh) | 用于双余度无刷直流电动舵机的滑模控制方法和驱动装置 | |
CN105141195B (zh) | 一种水下航行器用大功率双转无刷直流电机控制系统 | |
CN107370431A (zh) | 一种工业机器人用永磁同步电机模糊自抗扰控制方法 | |
CN202272170U (zh) | 一种电动舵系统 | |
CN104210640B (zh) | 一种平流层浮空器矢量推进装置 | |
CN102114782A (zh) | 一种电动汽车的滑移率检测方法及检测系统 | |
CN105490604A (zh) | 一种三相四开关感应电动机变频调速系统的预测控制方法 | |
US20150149005A1 (en) | Torque monitoring system and method | |
CN105197232A (zh) | 油电混动多旋翼无人飞行器 | |
CN105790666A (zh) | 基于霍尔信号的无刷直流电机直接转矩控制系统和方法 | |
CN105035984A (zh) | 一种双绕组永磁容错电机垂直提升系统及其控制方法 | |
CN105043774B (zh) | 一种采用插值计算舵机功耗的方法 | |
CN106026834A (zh) | 一种永磁同步电机的无速度传感器控制方法 | |
CN103235505B (zh) | 双余度无刷直流电动舵机的灰色滑模控制方法和驱动装置 | |
WO2017124438A1 (zh) | 电子调速器与电机的连接器、动力系统及无人飞行器 | |
CN102055405A (zh) | 一种无刷双馈电机控制装置及其直接转矩控制方法 | |
CN103224022B (zh) | 用于双y型无刷直流电动舵机的灰色滑模控制方法及装置 | |
CN103213506B (zh) | 一种用于飞机电刹车双y型无刷直流电机的控制方法 | |
CN103223938B (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150715 Termination date: 20160506 |
|
CF01 | Termination of patent right due to non-payment of annual fee |