CN103224022A - 用于双y型无刷直流电动舵机的灰色滑模控制方法及装置 - Google Patents
用于双y型无刷直流电动舵机的灰色滑模控制方法及装置 Download PDFInfo
- Publication number
- CN103224022A CN103224022A CN2013101627148A CN201310162714A CN103224022A CN 103224022 A CN103224022 A CN 103224022A CN 2013101627148 A CN2013101627148 A CN 2013101627148A CN 201310162714 A CN201310162714 A CN 201310162714A CN 103224022 A CN103224022 A CN 103224022A
- Authority
- CN
- China
- Prior art keywords
- rudder face
- motor
- signal
- given
- double
- 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.)
- Granted
Links
Images
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Motors That Do Not Use Commutators (AREA)
Abstract
本发明提供了一种用于双Y型无刷直流电动舵机的灰色滑模控制方法及装置,舵机驱动控制器接收舵面位置给定信号以及舵面位置反馈信号,经过滑模控制方法解算,驱动双Y型绕组无刷直流电机工作,力矩通过传动齿轮组施加在受控舵面,使舵面按照给定的舵面位置信号进行动作。本发明平衡电机两套绕组电流,解决力纷争问题,同时提高舵***的可靠性。
Description
技术领域
本发明涉及一种用于双余度无刷直流电动舵机的灰色滑模控制方法和驱动装置。背景技术
无刷直流电动舵机具有体积小、可靠性高、性能优良的特点,在飞行器舵机***中得到了广泛的应用。目前,舵机余度控制***发展迅速,目前的成果有:公开号为CN101799689A的专利《双余度舵机控制器》采用双余度设计,但仅对功率驱动电路进行了双余度设计,出力电机仍为单余度电机,其***可靠性有待提高;公开号为CN202632110U的专利《一种双余度舵机***》也采用双余度设计,但是,其更侧重对***的故障诊断与隔离,对于电机控制方法,依然采用经典的PID控制,控制精度不高。
发明内容
为了克服现有技术的不足,本发明提出了一种用于双Y型无刷直流电动舵机的灰色滑模控制方法及装置,提高舵***的可靠性。
本发明解决其技术问题所采用的技术方案包括以下步骤:
第一步,控制器分别采集电机转速ωr、电机绕组1电流反馈信号i1及电机绕组2电流反馈信号i2,转至第二步。
第二步,经速度观测器:
得电机转速微分和转矩观测值微分其中,CT1为电机绕组1转矩常数,CT2为电机绕组2转矩常数,J为电机转动惯量,为负载力矩观测值,为电机转速观测值,c1为观测器系数(0<c1<100000),c2为观测器系数(-50000<c1<0)。转至第三步
第四步,建立灰色模型GM(1,1):
x(0)(k)+az(1)(k)=b
得出***相应的白化方程为:
其中,参数-a为发展系数,反映了灰色***GM(1,1)的发展态势,参数b为灰色作用量,是从背景值中发掘出来的的数据。
X(0)的1-AGO序列为:X(1)=(x(1)(1),x(1)(2),x(1)(3),x(1)(4),x(1)(5))
第五步,计算X(1)的近邻均值生成序列:Z(1)=(z(1)(2),z(1)(3),z(1)(4),z(1)(5)),其中, k=2,…,5;转至第六步。
第六步,计算中间矩阵Y,BT
其中,
Y=[θ(t-3),θ(t-2),θ(t-1),θ(t)]T
则灰色***GM(1,1)的参数为:[a,b]T=(BTB)-1BTY;转至第七步。
第七步,计算舵机***t+1时刻舵面位置:
第八步,控制器接收给定舵面位置θgv;转至第九步。
第九步,计算舵面位置误差转至第十步。
第十一步,采集电机角速度ω,计算速度给定ωgv,其中:
第十二步,计算速度误差信号eω=ωgv-ω;转至第十三步。
第十六步,进行均流环PID控制,驱动双余度无刷直流电机工作;转至第一步。
本发明还提供了如下的驱动装置:包括舵机驱动控制器部分,双Y型绕组无刷直流电机,传动齿轮组和受控舵面部分。驱动控制器部分接收舵面位置给定信号以及舵面位置反馈信号,经过驱动控制器算法控制,驱动双Y型绕组无刷直流电机工作,力矩通过传动齿轮组施加在受控舵面,使舵面按照给定的舵面位置信号进行动作。
其中,舵机驱动控制器包括控制器DSP单元、数字隔离电路单元、驱动电路单元、主功率电路单元、电流采集电路单元、速度信号采集单元、位置传感器、位置给定信号调理电路单元、位置反馈信号调理电路单元和RS-422通信单元,舵面位置给定信号和舵面位置反馈信号分别经过位置给定信号调理电路单元和位置反馈信号调理电路单元输入控制器DSP单元,进行模数转换,控制器DSP单元接收到舵面位置指令后,通过滑模控制算法,输出驱动信号,驱动信号经数字隔离电路单元和驱动电路单元,驱动主功率电路,控制双Y型绕组无刷直流电机工作;双Y型绕组无刷直流电机的母线电流经电流采集电路单元采样,实现电流环闭环控制;速度信号采集单元采集电机的当前转速,反馈回控制器DSP单元,用以实现转速的闭环控制;与齿轮组相连的位置传感器实时反馈舵面的当前位置,传给控制器DSP单元,完成舵面位置闭环控制;舵面位置实际测量值经RS-422通信单元传给上位机进行监测。
本发明的有益效果是:以双Y型绕组无刷直流电机伺服***为研究对象,提出了一种滑模均流控制策略,平衡电机两套绕组电流,解决力纷争问题,同时提高舵***的可靠性。
附图说明
图1是本发明的方法流程图;
图2是本发明控制装置的原理框图;
图中,1—舵机控制器,2—双Y型绕组无刷直流电机,3—传动齿轮组,4—受控舵面,5—RS-422通信单元,6—给定信号调理电路单元,7—DSP控制单元,8—数字隔离电路单元,9—驱动单元,10—主功率电路单元,11—电流传感器,12—反馈信号调理电路,13—舵面位置传感器,14—速度信号采集单元。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
本发明的控制方法包括以下步骤:
第一步,控制器分别采集反馈负载力矩TL,电机转速ωr,分电机绕组1电流反馈信号i1及电机绕组2电流反馈信号i2,转至第二步。
第二步,经速度观测器
得电机转速微分和转矩观测值微分其中,CT1为电机绕组1转矩常数,CT2为电机绕组2转矩常数,J为电机转动惯量,为负载力矩观测值,为电机转速观测值,c1为观测器系数(0<c1<100000),c2为观测器系数(-50000<c1<0)。转至第三步
第四步,建立灰色模型GM(1,1):
x(0)(k)+az(1)(k)=b
得出***相应的白化方程为:
其中,参数-a为发展系数,反映了灰色***GM(1,1)的发展态势,参数b为灰色作用量,是从背景值中发掘出来的的数据。
X(0)的1-AGO序列为:X(1)=(x(1)(1),x(1)(2),x(1)(3),x(1)(4),x(1)(5))
第五步,计算X(1)的近邻均值生成序列:Z(1)=(z(1)(2),z(1)(3),z(1)(4),z(1)(5))其中, k=2,..,;转至第六步。
第六步,计算中间矩阵Y,BT
其中,
Y=[θ(t-3),θ(t-2),θ(t-1),θ(t)]T
则灰色***GM(1,1)的参数为:[a,b]T=(BTB)-1BTY;转至第七步。
第七步,计算舵机***t+1时刻舵面位置:
第八步,控制器接收给定舵面位置θgv;转至第九步。
第九步,计算舵面位置误差转至第十步。
第十一步,采集电机角速度ω,计算速度给定ωgv,其中:
第十二步,计算速度误差信号eω=ωgv-ω;转至第十三步。
第十六步,进行均流环PID控制,驱动双余度无刷直流电机工作;转至第一步。
本发明的驱动装置包括舵机控制器1,双Y型绕组无刷直流电机2,传动齿轮组3,受控舵面4。舵机控制器1接收舵面位置给定信号以及舵面位置反馈信号,经过控制器算法控制,驱动双Y型绕组无刷直流电机2工作,力矩通过传动齿轮3组施加在受控舵面4,使受控舵面4按照给定的舵面位置信号进行动作。
其中,舵机控制器部分包括:RS-422通信单元5、给定信号调理电路单元6、DSP控制单元7、数字隔离电路单元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<c1<0;
第四步,建立灰色模型GM(1,1):x(0)(k)+az(1)(k)=b;
其中,参数-a为发展系数,参数b为灰色作用量;
X(0)的1-AGO序列为:X(1)=(x(1)(1),x(1)(2),x(1)(3),x(1)(4),x(1)(5));
其中, k=1,2.,.;
第五步,计算X(1)的近邻均值生成序列:Z(1)=(z(1)(2),z(1)(3),z(1)(4),z(1)(5)),其中, k=2,…,5;
第六步,计算中间矩阵Y,BT
Y=[θ(t-3),θ(t-2),θ(t-1),θ(t)]T
则灰色***GM(1,1)的参数为:[a,b]T=(BTB)-1BTY;
第八步,控制器接收给定舵面位置θgv;
第十一步,采集电机角速度ω,计算速度给定ωgv,其中:
第十二步,计算速度误差信号eω=ωgv-ω;
第十四步,计算均流电流给定,
第十六步,进行均流环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 |
---|---|---|---|
CN201310162714.8A CN103224022B (zh) | 2013-05-06 | 2013-05-06 | 用于双y型无刷直流电动舵机的灰色滑模控制方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310162714.8A CN103224022B (zh) | 2013-05-06 | 2013-05-06 | 用于双y型无刷直流电动舵机的灰色滑模控制方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103224022A true CN103224022A (zh) | 2013-07-31 |
CN103224022B CN103224022B (zh) | 2015-06-17 |
Family
ID=48834716
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310162714.8A Expired - Fee Related CN103224022B (zh) | 2013-05-06 | 2013-05-06 | 用于双y型无刷直流电动舵机的灰色滑模控制方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103224022B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000522A (zh) * | 2018-08-16 | 2018-12-14 | 上海航天控制技术研究所 | 差动式双余度舵机的安全优化控制方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101340173A (zh) * | 2008-04-30 | 2009-01-07 | 沈阳工业大学 | 一种抑制直线电机推力***脉动的方法 |
CN201910764U (zh) * | 2010-12-14 | 2011-07-27 | 长春工业大学 | 一种基于终端滑模的永磁同步电机直接转矩控制*** |
US8239105B2 (en) * | 2007-11-22 | 2012-08-07 | Mitsubishi Electric Corporation | Control device and control method of automatic transmission |
-
2013
- 2013-05-06 CN CN201310162714.8A patent/CN103224022B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8239105B2 (en) * | 2007-11-22 | 2012-08-07 | Mitsubishi Electric Corporation | Control device and control method of automatic transmission |
CN101340173A (zh) * | 2008-04-30 | 2009-01-07 | 沈阳工业大学 | 一种抑制直线电机推力***脉动的方法 |
CN201910764U (zh) * | 2010-12-14 | 2011-07-27 | 长春工业大学 | 一种基于终端滑模的永磁同步电机直接转矩控制*** |
Non-Patent Citations (1)
Title |
---|
高航: "直流电动机的优化滑模变结构控制", 《计算机仿真》, vol. 26, no. 8, 15 August 2009 (2009-08-15), pages 341 - 344 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000522A (zh) * | 2018-08-16 | 2018-12-14 | 上海航天控制技术研究所 | 差动式双余度舵机的安全优化控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103224022B (zh) | 2015-06-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110518846B (zh) | 基于惯量辨识的多电机伺服***自抗扰滑模速度控制方法 | |
CN106227189B (zh) | 一种双轴驱动电动汽车硬件在环测试***同步控制方法 | |
CN102497157B (zh) | 绕组分段直线电机的无传感器控制装置及控制方法 | |
CN102654431B (zh) | 具有机械模拟和电惯量模拟结合的制动器试验台 | |
CN103213673A (zh) | 一种用于双y型无刷直流电动舵机的控制方法和驱动装置 | |
CN102662323B (zh) | 风力发电变桨距执行机构的自适应滑模控制方法及*** | |
CN103532459A (zh) | 一种数控机床驱动用直线伺服电机控制方法 | |
CN104283478A (zh) | 一种电动汽车用永磁同步电机电流控制***及控制方法 | |
CN103838145A (zh) | 基于级联观测器的垂直起降飞机鲁棒容错控制***及方法 | |
CN104210640B (zh) | 一种平流层浮空器矢量推进装置 | |
CN108177693A (zh) | 轮毂驱动电动汽车的电子差速控制*** | |
CN103818391B (zh) | 一种用于动车组的快速粘着控制方法 | |
CN107769642A (zh) | 一种直流电机的驱动‑调速一体式约束预测控制方法 | |
CN108132608B (zh) | 一种机器人关节控制器功率级半物理仿真*** | |
CN105610369A (zh) | 一种基于滑模观测器的异步电机磁链观测方法 | |
Mingkai et al. | Battery package design optimization for small electric aircraft | |
CN102055402B (zh) | 感应电机的转速与参数同时辨识方法 | |
CN104340802B (zh) | 一种电梯防溜车驱动控制***及驱动控制方法 | |
CN103279128A (zh) | 用于双余度无刷直流电动舵机的滑模控制方法和驱动装置 | |
CN104242744A (zh) | 一种基于优化灰色预测补偿的永磁同步电机转速控制方法 | |
CN105043774B (zh) | 一种采用插值计算舵机功耗的方法 | |
CN103235505A (zh) | 双余度无刷直流电动舵机的灰色滑模控制方法和驱动装置 | |
CN110376884B (zh) | 一种新能源汽车驱动电机动态抗干扰控制器的构造方法 | |
CN103248290A (zh) | 用于飞机电刹车双余度无刷直流电机的灰色滑模控制方法 | |
CN105186958A (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: 20150617 Termination date: 20160506 |
|
CF01 | Termination of patent right due to non-payment of annual fee |