摘要
针对受外部干扰和模型不确定性影响的永磁球形电机运动系统,提出一种基于有限时间干扰观测器的全阶滑模控制方法。首先,在复合干扰下建立永磁球形电机的动力学模型,其不确定性包括建模误差和外界干扰。其次,设计有限时间干扰观测器以快速、准确地估计出系统的复合干扰。然后,为永磁球形电机设计了全阶滑模面,理想滑模运动时反映其全阶动态特性,而不是传统滑模控制系统中的降阶动态特性。最后,通过李雅普诺夫定理证明了所提控制方法的闭环系统的稳定性。仿真和实验结果表明所提控制器在复合干扰情况下具有良好的动态特性和抗干扰能力。
关键词
近年来,随着工业技术的快速发展,多自由度球形电机的设计和研究引起了全世界的广泛关注。传统的多自由度伺服装置是通过控制多台单轴电机并结合复杂的齿轮结构来实现的,这不可避免地会导致系统机械结构复杂、体积庞大,造成动态响应慢、精确度降低和缺乏灵活性等问题。为了克服这些缺点,研究人员提出了能在单台电机上实现三自由度运动的球形电机。与传统的多自由度伺服装置相比,球形电机具有结构紧凑、直接驱动和良好的动态性能等优点。
为实现球形电机的多自由度运动,有必要设计具有良好动态性能的控制算法。文献[
滑模控制是一种鲁棒控制方法,具有对建模误差和不确定性干扰不敏感的优点,已广泛应用于非线性系统
本文针对一种永磁球形电机运动系统,提出了一种基于有限时间干扰观测器的全阶滑模控制方法。有限时间干扰观测器用来估计复合干扰;设计全阶滑模面,使永磁球形电机的理想滑模运动表达其全阶动态特性;设计连续滑模控制律,在控制输入端补偿其复合干扰,获得良好的跟踪性能和动态特性。最后,通过与PD控制和传统滑模控制仿真对比,验证了所提控制算法的优越性。
文献[


图1 PMSA的机械结构
Fig.1 Mechanical structure of PMSA
永磁球形电机由转子中的永磁体和定子通电线圈相互作用产生的电磁转矩驱动。在期望的线圈通电驱动控制下,转子能够产生相应的转矩实现其倾斜、俯仰和自旋三自由度运动。实验样机如

图2 永磁球形电机实验样机
Fig.2 Experimental prototype of PMSA
为建立永磁球形电机的动力学模型,引入定子坐标系XYZ和转子坐标系uvw。坐标系XYZ位于定子球壳上,坐标系uvw固定在转子球体上。转子球所确定的位置变化可以用广义欧拉角(α,β,γ)表示。

图3 坐标变换
Fig.3 Coordinate transformation
(1) |
结合拉格朗日第2方程,永磁球形电机的动力学模型为
(2) |
式中:表示转子位置,其一阶和二阶导数和分别对应着角速度和角加速度;为惯性矩阵;为哥氏力及离心力矩阵;为控制转矩力矩;为外界干扰力矩;为外加负载力矩;、为
(3) |
(4) |
式中
(5) |
式中:、和分别表示绕u轴、v轴和w轴旋转的转动惯量。从永磁球形电机的机械结构容易得出,转子沿输出轴方向上是严格对称的,故,设。
永磁球形电机建模过程中,不可避免地会存在建模误差。为了量化建模误差,实际惯性矩阵和实际哥氏力及离心力矩阵分别定义为
(6) |
(7) |
式中:和分别为线性建模误差系数。在实际系统中,这两个系数的范围为。
考虑上述因素,将永磁球形电机动力学模型(2)改写为
(8) |
式中表示永磁球形电机运动系统中复合干扰力矩
(9) |
其包括外界干扰,负载力矩和模型不确定性。
性质1 惯性矩阵是对称,有界和正定的。
性质2 矩阵̇是倾斜对称的,且有
(10) |
永磁球形电机在操作过程中存在包括外界干扰、未知有效载荷和建模误差等复合干扰,这些不利干扰将会在很大程度上降低永磁球形电机的动态特性。为此,提出一种有限时间干扰观测器,能够使复合干扰的观测值在有限时间内收敛到其实际值。控制器结构如

图4 所提控制器流程图
Fig.4 Schematic of the proposed controller
为了设计有限时间干扰观测器,首先,定义永磁球形电机的广义动量为,则
(11) |
设计如下有限时间干扰观测
(13) |
式中:为的估计值,为的估计值,,,,的对角正定矩阵。
根据有限时间干扰观测器(13),使用收敛分析法检测该干扰观测器的稳定性和收敛性。观测误差定义为
(14) |
式中。根据文献[
基于所提的有限时间干扰观测器,设计基于有限时间干扰观测的全阶滑模控制方法处理复合干扰。首先,定义永磁球形电机系统的跟踪误差为
(15) |
式中、分别为期望的轨迹及其角速度。
设计全阶滑模面如下
(16) |
式中:,且满足多项式为赫维兹稳定,即多项式的特征值都在复平面的左半边。参数、满足等式:,。
设计滑模控制律
(17) |
式中、为正常数。
定理1 对于在滑模控制率(17)下具有全阶滑模面(16)的永磁球形电机系统(8),永磁球形电机的轨迹跟踪误差将在有限时间内收敛到原点。
证明 根据永磁球形电机系统(8)和全阶滑模面(16)获得闭环全阶滑模动态特性。
取全阶滑模面(16)对时间的导数,可得
(18) |
将控制率(17)代入
(19) |
式中。根据2.1节可知,观测误差将在有限时间内收敛到原点,因此将在有限时间内收敛到原点。
(1)证明在有限时间内,,误差不会将滑动变量s推动到无穷大。
为
(20) |
(21) |
式中:,。
(2)证明滑动变量将在有限时间内收敛到。
因为滑动变量不会在有限时间内发散到无穷大,又有将在有限时间内收敛到原点,当时,可将
(22) |
根据文献[
(3)证明滑动变量在任意有限时间内不会将误差,驱动到无穷大。
根据全阶滑模面(16),可以得到永磁球形电机系统的误差动态特性
(23) |
为
(24) |
下面,证明在有限时间内有界,对
(25) |
又有,当时,不等式成立,
(26) |
式中:,。、分别为矩阵和中最大的元素。因此,可知有界,这就表明误差、不会在有限时间内发散到无穷大。
(4)证明永磁球形电机的轨迹跟踪误差将在有限时间内收敛到原点。
一旦满足理想滑模面,永磁球形电机的误差动态方程为
(27) |
或者为
(28) |
此时,
如果选择参数满足不等式,,中的元素确保多项式为赫维兹稳定。则系统(28)可以在有限时间内从任何初始条件沿着全阶滑模面收敛到平衡
至此,完成了定理1的证明。
影响永磁球形电机轨迹跟踪性能的两个重要因素:建模误差和干扰。本节主要通过对这两方面进行仿真以评估所提控制器的性能。
根据第1节中永磁球形电机的实际尺寸和结构参数,仿真计算出其转动惯量
(29) |
(30) |
设期望轨迹为
(31) |
系统的初始条件设置为
(32) |
根据
(33) |
外界干扰设置为
(34) |
式中为之间的随机数。
负载力矩设置为
(35) |
式中,为负载力矩的系数。
所提控制器参数如下。有限时间干扰观测器增益矩阵选择为、,功率系数选择为,。全阶滑模面增益矩阵选择,,功率系数选择为,, 。
在相同的期望轨迹和外界干扰下,3.1节和3.2节分别设计为在相同负载力矩情况下改变模型不确定性和在相同模型不确定下改变负载力矩的仿真实验。为了比较分析,设计了3种控制方案:(1)所提的基于干扰观测器的全阶滑模控制(Finite-time disturbance observer based full-order sliding-mode control FTDO‑FOSMC);(2)PD控制;(3) 传统的滑模控制(Sliding mode control, SMC)。
本节将负载力矩系数L设置为0,改变建模不确定性系数r从0.1~0.5。
图

图5 位置响应(L=0,r=0.3)
Fig.5 Response curves of position (L=0, r=0.3)

图6 轨迹跟踪误差响应(L=0,r=0.3)
Fig.6 Response curves of tracking error (L=0, r=0.3)
为了更直观地比较3个控制器的性能,

图7 3种控制器下轨迹跟踪误差的均方根误差 (L=0)
Fig.7 RMSE of trajectory tracking error under three controllers (L=0)
本节中,将建模不确定性系数r设置为0.2,负载力矩系数L从1~5变化。
图

图8 位置响应 (L=3, r=0.2)
Fig.8 Response curves of position (L=3, r=0.2)

图9 轨迹跟踪误差响应 (L=3, r=0.2)
Fig.9 Response curves of tracking error (L=3, r=0.2)

图10 3种控制器下轨迹跟踪误差的均方根误差(r=0.2)
Fig.10 RMSE of trajectory tracking error under three controllers (r=0.2)
更进一步,

图11 控制力矩输入 (L=3, r=0.2)
Fig.11 Control torque input (L=3, r=0.2)

图12 实验平台
Fig12 Experimental platform
(36) |
实验中,将FTDO‑FOSMC控制与PD控制相比较研究。

图13 PD控制下轨迹跟踪响应
Fig.13 Trajectory tracking response under PD control

图14 FTDO-FOSMC控制下轨迹跟踪响应
Fig.14 Trajectory tracking response under FTDO‑FOSMC control
本文主要研究受复合干扰影响下的永磁球形电机轨迹跟踪控制。针对复合干扰,提出了一种基于有限时间干扰观测器的全阶滑模控制算法。有限时间干扰观测器对复合干扰进行了实时估计,全阶滑模控制算法使永磁球形电机的理想滑模运动具有完整的动态特性。仿真结果表明,在不同的复合干扰下,所提出的控制算法能够以较小的误差实现轨迹跟踪,具有良好的鲁棒性和抗干扰能力,并能够有效抑制控制输入的抖振现象。实验结果表明,使用所提控制算法稳态轨迹跟踪误差小于0.63°,比常规的PD控制算法减少约50%。因此,所提控制算法能够实现永磁球形电机良好的跟踪性能,为永磁球形电机未来在工程中的应用奠定基础。
参考文献
Son H, Lee K. Control system design and input shape for orientation of spherical wheel motor[J]. Control Engineering Practice, 2014, 24: 120-128. [百度学术]
Wang W, Wang J, Jewell G W, et al. Design and control of a novel scpherical permanent magnet actuator with three degrees of freedom[J]. IEEE/ASME Transactions on Mechatronics, 2003, 8(4): 457-468. [百度学术]
过希文,王群京,李国丽,等.基于摩擦补偿的永磁球形电机自适应模糊控制[J].中国电机工程学报,2011,31(15): 75-81. [百度学术]
Guo Xiwen, Wang Qunjing, Li Guoli, et al. Adaptive fuzzy control for permanent magnet spherical motor based on friction compensation[J]. Proceedings of the CSEE, 2011, 31(15): 75‑81. [百度学术]
Xia Changliang, CHEN Guo, SHI Tingna. A neural-network-identifier and fuzzy-controller-based algorithm for dynamic decoupling control of permanent-magnet spherical motor[J]. IEEE Transactions on Industrial Electronics, 2010, 57(8): 2868-2878. [百度学术]
Yan L, Zhang L, Zhu B, et al. Single neural adaptive controller and neural network identifier based on PSO algorithm for spherical actuators with 3D magnet array[J]. Rev Sci Instrum, 2017,88(10): 1-12. [百度学术]
过希文,王群京,李国丽,等.永磁球形电机的自适应反演滑模控制[J].南京航空航天大学学报,2014,46(1):59-64. [百度学术]
Guo Xiwen, Wang Qunjing, Li Guoli, et al. Adaptive backstepping sliding mode control in permanent magnet spherical motor[J]. Journal of Nanjing University of Aeronautics & Astronautics, 2014, 46(1): 59‑64. [百度学术]
Liu Jingmeng, Deng Huiyang, Chen Weihai, et al. Robust dynamic decoupling control for permanent magnet spherical actuators based on extended state observer[J]. IET Control Theory & Applications, 2017, 11(5): 619-631. [百度学术]
Wen Yan, Li Guoli, Wang Qunjing, et al. Robust adaptive sliding-mode control for permanent magnet spherical actuator with uncertainty using dynamic surface approach[J]. Journal of Electrical Engineering & Technology, 2019, 14(6): 2341-2353. [百度学术]
Liu Jingmeng, Deng Huiyang, Hu Cungang, et al. Adaptive backstepping sliding mode control for 3-DOF permanent magnet spherical actuator[J]. Aerospace Science and Technology, 2017, 67: 62-71. [百度学术]
李洪凤,柳文俊.永磁球形电机的少保守性滑模控制[J].控制理论与应用,2018,35(2):137-145. [百度学术]
Li Hongfeng, Liu Wenjun. Less conservative sliding mode control of permanent magnet spherical motor [J]. Control Theory & Applications, 2018,35(2):137-145. [百度学术]
彭麒麟,宗群,王丹丹,等.基于连续螺旋滑模的无人机分布式编队控制[J].南京航空航天大学学报,2019,51(6): 778-784. [百度学术]
Peng Qilin, Zong Qun, Wang Dandan, et al. Distributed formation control of uavs based on continuous spiral sliding mode[J]. Journal of Nanjing University of Aeronautics & Astronautics, 2019,51(6):778-784. [百度学术]
Feng Yong, Han Fengling, Yu Xinghuo. Chattering free full-order sliding-mode control[J]. Automatica, 2014, 50(4): 1310-1314. [百度学术]
Fang Xing, Liu Fei. A finite-time disturbance observer based full-order terminal sliding-mode controller for manned submersible with disturbances[J]. Mathematical Problems in Engineering, 2018,2018:1-11. [百度学术]
都延丽,尹佳杰,孟亦真,等.高超声速飞行器自适应抗饱和再入控制[J].南京航空航天大学学报,2015,47(6): 833-841. [百度学术]
Du Yanli, Yin Jiajie, Meng Yizhen, et al. Adaptive reentry control for hypersonic vehicles with saturation[J]. Journal of Nanjing University of Aeronautics & Astronautics, 2015,47(6): 833-841. [百度学术]
Cao Pengfei, Gan Yahui, Dai Xianzhong. Finite-time disturbance observer for robotic manipulators[J]. Sensors, 2019, 19(8): 1943-1954. [百度学术]
Qian Zhe,Wang Qunjing,Ju Lufeng,et al.Torque modeling and control algorithm of a permanent magnetic spherical motor[C]//Proceedings of the 12th International Conference on Electrical Machines and Systems.Tokyo,Japan:IEEJ Industry Applications Society,2009:944-949. [百度学术]
Bhat S P, Bernstein D S. Geometric homogeneity with applications to finite-time stability[J]. Mathematics of Control, Signals and Systems, 2005, 17(2): 101-127. [百度学术]