CN103224022B - 用于双y型无刷直流电动舵机的灰色滑模控制方法及装置 - Google Patents
用于双y型无刷直流电动舵机的灰色滑模控制方法及装置 Download PDFInfo
- Publication number
- CN103224022B CN103224022B CN201310162714.8A CN201310162714A CN103224022B CN 103224022 B CN103224022 B CN 103224022B CN 201310162714 A CN201310162714 A CN 201310162714A CN 103224022 B CN103224022 B CN 103224022B
- Authority
- CN
- China
- Prior art keywords
- motor
- rudder face
- current
- signal
- 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.)
- Expired - Fee Related
Links
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为灰色作用量,是从背景值中发掘出来的的数据。
连续采集t-4,...,t时刻计算观测的电机位置构成非负序列
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;转至第七步。
第七步,计算舵机系统t+1时刻舵面位置:
第八步,控制器接收给定舵面位置θ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通信单元传给上位机进行监测。
本发明的有益效果是:以双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为灰色作用量,是从背景值中发掘出来的的数据。
连续采集t-4,...,t时刻计算观测的电机位置构成非负序列
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,..,;转至第六步。
第六步,计算中间矩阵Y,BT
其中,
Y=[θ(t-3),θ(t-2),θ(t-1),θ(t)]T
则灰色系统GM(1,1)的参数为:[a,b]T=(BTB)-1BTY;转至第七步。
第七步,计算舵机系统t+1时刻舵面位置:
第八步,控制器接收给定舵面位置θ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按照给定的舵面位置信号进行动作。
其中,舵机控制器部分包括: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<c2<0;
第三步,计算观测的电机位置
第四步,建立灰色模型GM(1,1):x(0)(k)+az(1)(k)=b;
得出系统相应的白化方程为:
其中,参数-a为发展系数,参数b为灰色作用量;
连续采集t-4,...,t时刻计算观测的电机位置构成非负序列
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)),其中,
第六步,计算中间矩阵Y,BT
Y=[θ(t-3),θ(t-2),θ(t-1),θ(t)]T
则灰色系统GM(1,1)的参数为:[a,b]T=(BTB)-1BTY;
第七步,计算舵机系统t+1时刻舵面位置
第八步,控制器接收给定舵面位置θ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 |
---|---|---|---|
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 CN103224022A (zh) | 2013-07-31 |
CN103224022B true 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) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000522B (zh) * | 2018-08-16 | 2020-08-28 | 上海航天控制技术研究所 | 差动式双余度舵机的安全优化控制方法 |
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 |
---|
直流电动机的优化滑模变结构控制;高航;《计算机仿真》;20090815;第26卷(第8期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN103224022A (zh) | 2013-07-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103213673B (zh) | 一种用于双y型无刷直流电动舵机的控制方法和驱动装置 | |
CN104283478B (zh) | 一种电动汽车用永磁同步电机电流控制系统及控制方法 | |
CN111756286B (zh) | 一种高性能鲁棒永磁同步轮毂电机复合控制器 | |
CN102497157B (zh) | 绕组分段直线电机的无传感器控制装置及控制方法 | |
CN103684182B (zh) | 一种永磁同步电机参数辨识方法 | |
CN202872721U (zh) | 一种基于级联高压变频器无速度传感器矢量控制系统 | |
CN102654431B (zh) | 具有机械模拟和电惯量模拟结合的制动器试验台 | |
CN107317532A (zh) | 基于滑模的永磁同步电机预测电流控制方法和系统 | |
CN200940062Y (zh) | 永磁同步电机驱动的电梯门机控制装置 | |
CN103414425B (zh) | 一种无刷直流电机的转矩方向和幅值的检测方法 | |
CN103273857A (zh) | 一种主从式多电机驱动系统的效率优化方法 | |
CN106227189A (zh) | 一种双轴驱动电动汽车硬件在环测试系统同步控制方法 | |
CN104210640B (zh) | 一种平流层浮空器矢量推进装置 | |
CN107769642A (zh) | 一种直流电机的驱动‑调速一体式约束预测控制方法 | |
CN103051274A (zh) | 基于变阻尼的二自由度永磁同步电机的无源性控制方法 | |
CN104533716B (zh) | 一种基于卡尔曼滤波的独立变桨载荷控制方法 | |
CN106042976A (zh) | 一种分布式驱动电动汽车在线实时转矩优化分配控制方法 | |
CN103281020B (zh) | 一种用于电动舵机的四象限控制装置及其方法 | |
CN105610369A (zh) | 一种基于滑模观测器的异步电机磁链观测方法 | |
CN103235505B (zh) | 双余度无刷直流电动舵机的灰色滑模控制方法和驱动装置 | |
CN103279128A (zh) | 用于双余度无刷直流电动舵机的滑模控制方法和驱动装置 | |
CN102055402B (zh) | 感应电机的转速与参数同时辨识方法 | |
CN104242744A (zh) | 一种基于优化灰色预测补偿的永磁同步电机转速控制方法 | |
CN103223938B (zh) | 一种用于飞机电刹车无刷直流电机的灰色滑模控制方法 | |
CN105186958B (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150617 Termination date: 20160506 |