用于移动机器人永磁同步电机的超螺旋滑模位置控制方法
本发明涉及电机控制,特别涉及一种用于移动机器人永磁同步电机的超螺旋滑模位置控制方法。
背景技术:
1、永磁同步电机(pmsm)具有功率密度高、转矩电流比大、转动惯量低及运行效率高等特点,已广泛应用于移动机器人的驱动轮、转向执行机构和旋转关节等位置伺服系统。在实际运行中,移动机器人常面临坡道行驶、载荷变化、轮地附着条件改变、碰撞冲击及传动摩擦变化等复杂工况,导致折算至电机轴端的等效转动惯量、黏性摩擦系数和集总负载转矩发生显著变化,严重影响位置跟踪精度与抗扰性能。
2、目前,永磁同步电机位置控制常采用比例积分(pi)控制、滑模控制(smc)、自适应控制及扰动观测补偿等方法。其中,滑模控制利用位置误差及其变化状态构造滑模变量并生成控制量,超螺旋滑模控制进一步引入连续非线性反馈项和积分项,可与变增益方法结合以适应工况变化。扰动观测方法则根据电机运动模型及可测信号估计负载变化或模型不确定性,并通过补偿控制减小其对位置跟踪的影响。
3、然而,现有超螺旋位置控制器通常采用固定增益或仅根据原始滑模变量调节增益。固定增益较小时,负载突变后控制强度不足,位置偏差增大且恢复时间延长;固定增益较大时,误差减小后仍保持较强控制作用,易造成交轴电流波动和稳态位置抖动。仅依据原始滑模变量调节增益时,需等待滑模偏差明显增大后才能提高控制强度,无法同时反映位置误差相对于目标精度的接近程度及其变化趋势,在快速位置跟踪和突加负载工况下存在增益调节滞后的问题。此外,部分基于屏障函数的控制方法直接利用误差接近边界时快速增大的函数值生成控制量,易使控制作用在边界附近急剧增加;而现有负载转矩观测补偿方法多将观测结果作为单一前馈量叠加,未将观测速度用于滑模变量和增益生成,当负载转矩估计存在暂态误差时,仍会引起位置跌落和恢复时间延长。因此,亟需一种能够兼顾动态响应与稳态平滑性、有效抑制抖振并提高抗扰性能的位置控制方法。
技术实现思路
1、为了解决上述至少一个技术问题,本发明提出了一种用于移动机器人永磁同步电机的超螺旋滑模位置控制方法。
2、本发明第一方面提供了一种用于移动机器人永磁同步电机的超螺旋滑模位置控制方法,包括:
3、获取移动机器人永磁同步电机的累计机械角位置和三相定子电流,根据所述累计机械角位置和三相定子电流构建包含机械角速度和位置误差的旋转机械方程和误差加速度方程;
4、根据所述旋转机械方程和误差加速度方程定义位置误差及位置误差的实际导数,并构建原始位置滑模变量,对所述位置误差进行归一化及双曲正切压缩,得到压缩误差,并根据所述压缩误差及原始位置滑模变量构建切线型屏障风险函数与误差-滑模耦合风险量;
5、将所述耦合风险量经过区间投影算子生成主体基础增益,根据所述位置误差与实际滑模偏差构建带死区、泄漏及投影的自适应附加增益,将所述主体基础增益与所述自适应附加增益组合生成超螺旋增益;
6、根据所述压缩误差、所述位置误差与超螺旋积分状态构建超螺旋控制量,并由所述超螺旋控制量换算得到主体交轴电流分量;
7、获取所述永磁同步电机的实时交轴电流与机械角位置,利用正则化有限时间扩张状态观测器对所述实时交轴电流与机械角位置进行扩张状态估计,得到机械角速度估计值与负载转矩估计值;
8、根据所述机械角速度估计值更新可实现误差导数与可实现滑模变量,并利用所述可实现滑模变量更新所述超螺旋增益,根据所述负载转矩估计值构建等效交轴电流补偿分量;
9、将所述主体交轴电流分量、所述超螺旋控制量换算的交轴电流分量与所述等效交轴电流补偿分量融合,得到交轴电流控制律以驱动电机到达目标位置。
10、本方案中,所述获取移动机器人永磁同步电机的累计机械角位置和三相定子电流,根据所述累计机械角位置和三相定子电流构建包含机械角速度和位置误差的旋转机械方程和误差加速度方程,具体为:
11、获取移动机器人永磁同步电机的连续累计机械角位置和三相定子电流,将三相定子电流经过幅值不变形式的旋转坐标变换,得到直轴电流和交轴电流;
12、根据直轴电流、交轴电流以及永磁磁链建立磁链关系,结合直轴电压方程和交轴电压方程,得到电磁转矩与交轴电流的线性关系;
13、将移动机器人轮端阻力、传动摩擦及外部冲击统一折算为集总负载转矩,结合电机等效转动惯量和等效黏性摩擦系数,构建以机械角速度和累计机械角位置为状态量的旋转机械方程;
14、根据参考累计机械角位置与累计机械角位置的差值得到位置误差,对位置误差连续求导并代入旋转机械方程,导出误差加速度方程。
15、本方案中,所述根据所述旋转机械方程和误差加速度方程定义位置误差及位置误差的实际导数,并构建原始位置滑模变量,对所述位置误差进行归一化及双曲正切压缩,得到压缩误差,并根据所述压缩误差及原始位置滑模变量构建切线型屏障风险函数与误差-滑模耦合风险量,具体为:
16、定义参考累计机械角位置与累计机械角位置的差值为位置误差,根据参考累计机械角位置的时间导数与机械角速度作差,得到位置误差的实际导数;
17、根据所述位置误差和位置误差的实际导数构建原始位置滑模变量;
18、根据所述旋转机械方程和误差加速度方程,建立位置误差相对于时变风险尺度的度量,将所述位置误差除以所述时变风险尺度进行归一化处理,再对归一化结果进行双曲正切压缩处理,得到取值范围在开区间内的压缩误差;
19、对所述压缩误差求时间导数,得到压缩误差的导数;根据所述压缩误差及其导数构建变换误差滑模量;
20、定义切线型屏障风险函数,所述切线型屏障风险函数在压缩误差接近边界时函数值趋向无穷大,在压缩误差接近零时按二次量级缓慢变化;
21、根据所述变换误差滑模量和所述切线型屏障风险函数构建误差-滑模耦合风险量,所述误差-滑模耦合风险量的表达式为:
22、;
23、其中,为变换误差滑模量,为归一化尺度,为位置风险权重,为切线型屏障风险函数,为压缩误差,所述误差-滑模耦合风险量将位置误差的相对风险与滑模偏差风险耦合到同一调度通道中,当压缩误差或变换误差滑模量中的任一项增大时,所述误差-滑模耦合风险量均单调不减。
24、本方案中,所述将所述耦合风险量经过区间投影算子生成主体基础增益,根据所述位置误差与实际滑模偏差构建带死区、泄漏及投影的自适应附加增益,将所述主体基础增益与所述自适应附加增益组合生成超螺旋增益,具体为:
25、将所述误差-滑模耦合风险量输入区间投影算子,所述区间投影算子将输入变量限制在零与最大调度增益之间,经有界限制处理后输出主体基础增益,所述主体基础增益的表达式为:
26、;
27、其中,为调度系数,,为最大调度增益;
28、根据所述位置误差与参考累计机械角位置的时间导数构造原始位置滑模变量,定义死区指示函数,当所述原始位置滑模变量的绝对值大于死区阈值时所述死区指示函数输出为1,否则输出为0;
29、利用所述死区指示函数、原始位置滑模变量的幅值以及状态相关投影映射构建两路自适应附加增益,所述状态相关投影映射在当前增益值处于零边界且更新方向为负、或处于上限边界且更新方向为正时强制更新量为零,否则输出原更新量;
30、所述两路自适应附加增益的更新律分别包含与所述原始位置滑模变量幅值的平方根成正比的第一增长项、与所述原始位置滑模变量幅值成正比的第二增长项、以及与各自当前增益值成正比的泄漏项,当所述原始位置滑模变量的绝对值大于死区阈值时所述自适应附加增益随滑模偏差增大而增长,当所述原始位置滑模变量的绝对值不大于死区阈值时所述自适应附加增益在所述泄漏项作用下回落;
31、将所述主体基础增益进行平方根映射后与第一路自适应附加增益求和,再经区间投影算子限制在最小增益与最大增益之间,生成第一超螺旋增益;
32、将所述主体基础增益进行线性映射后与第二路自适应附加增益求和,再经区间投影算子限制在最小增益与最大增益之间,生成第二超螺旋增益,所述第一超螺旋增益用于调节超螺旋控制量的非线性反馈强度,所述第二超螺旋增益用于调节超螺旋控制量的积分强度。
33、本方案中,所述根据所述压缩误差、所述位置误差与超螺旋积分状态构建超螺旋控制量,并由所述超螺旋控制量换算得到主体交轴电流分量,具体为:
34、定义连续边界层函数,所述连续边界层函数根据原始位置滑模变量与边界层厚度的比值进行饱和限幅,当所述原始位置滑模变量大于所述边界层厚度时输出为1,当所述原始位置滑模变量的绝对值不大于所述边界层厚度时输出为所述原始位置滑模变量与所述边界层厚度的比值,当所述原始位置滑模变量小于所述边界层厚度的相反数时输出为-1;
35、根据所述连续边界层函数、所述第二超螺旋增益构建超螺旋积分状态,所述超螺旋积分状态的时间导数等于所述第二超螺旋增益与所述连续边界层函数的乘积;
36、根据所述连续边界层函数、所述第一超螺旋增益、所述原始位置滑模变量的绝对值的平方根以及所述超螺旋积分状态构建超螺旋控制量;
37、根据所述旋转机械方程和误差加速度方程,利用名义等效转动惯量、名义转矩系数和名义等效黏性摩擦系数构造名义等效交轴电流分量,所述名义等效交轴电流分量的表达式为:
38、;
39、其中,为名义等效转动惯量,为名义转矩系数,为参考累计机械角位置的二阶导数,为滑模系数且大于零,为位置误差的实际导数,为名义等效黏性摩擦系数,为机械角速度;
40、将所述超螺旋控制量换算为超螺旋交轴电流分量,所述超螺旋交轴电流分量等于所述名义等效转动惯量除以所述名义转矩系数再乘以所述超螺旋控制量;
41、将所述名义等效交轴电流分量与所述超螺旋交轴电流分量相加,得到主体交轴电流分量。
42、本方案中,所述获取所述永磁同步电机的实时交轴电流与机械角位置,利用正则化有限时间扩张状态观测器对所述实时交轴电流与机械角位置进行扩张状态估计,得到机械角速度估计值与负载转矩估计值,具体为:
43、根据旋转机械方程,将累计机械角位置作为第一扩张状态,机械角速度作为第二扩张状态,集总负载转矩的相反数作为第三扩张状态,建立扩张机械系统,其状态方程表达式为:
44、;
45、;
46、;
47、定义机械角位置观测误差,根据分数幂指数递推关系确定三级注入指数,构造正则化有限时间函数,当观测误差大于正则化边界阈值时取分数幂形式,当观测误差不大于正则化边界阈值时取五次多项式形式;
48、设置观测器带宽,计算三级观测增益,利用名义参数建立正则化有限时间扩张状态观测器,其连续时间更新方程为:
49、,
50、,
51、;
52、采用顺序半隐式离散方式对所述连续时间更新方程进行离散实现,先更新负载转矩扩张状态,再利用更新后的负载转矩扩张状态计算机械角速度,最后利用更新后的机械角速度计算机械角位置;
53、将离散更新后的扩张状态映射为机械角速度估计值与负载转矩估计值,完成对实时交轴电流与机械角位置的扩张状态估计。
54、本方案中,所述根据所述机械角速度估计值更新可实现误差导数与可实现滑模变量,并利用所述可实现滑模变量更新所述超螺旋增益,根据所述负载转矩估计值构建等效交轴电流补偿分量,具体为:
55、根据参考累计机械角位置的时间导数与所述机械角速度估计值作差,得到可实现误差导数,其表达式为:
56、;
57、其中,为参考累计机械角位置的时间导数,为机械角速度估计值;
58、根据所述可实现误差导数与位置误差构建可实现滑模变量,其表达式为:
59、;
60、其中,为大于零的滑模系数,为参考累计机械角位置,为累计机械角位置;
61、将所述可实现滑模变量替换原始位置滑模变量,重新计算变换误差滑模量,并根据所述变换误差滑模量更新切线型屏障风险函数与误差-滑模耦合风险量,将更新后的耦合风险量输入区间投影算子,生成更新后的主体基础增益;
62、根据所述可实现滑模变量更新死区指示函数,驱动两路自适应附加增益的更新律,将更新后的主体基础增益与更新后的自适应附加增益组合,生成更新后的第一超螺旋增益和第二超螺旋增益;
63、根据所述负载转矩估计值、机械角速度估计值、可实现误差导数以及参考累计机械角位置的二阶导数,构建等效交轴电流补偿分量,其表达式为:
64、;
65、其中,为名义等效转动惯量,为名义转矩系数,为参考累计机械角位置的二阶导数,为名义等效黏性摩擦系数,为负载转矩估计值。
66、本方案中,所述将所述主体交轴电流分量、所述超螺旋控制量换算的交轴电流分量与所述等效交轴电流补偿分量融合,得到交轴电流控制律以驱动电机到达目标位置,具体为:
67、将所述主体交轴电流分量与所述等效交轴电流补偿分量相加,再叠加由超螺旋控制量换算的交轴电流分量,得到统一交轴电流控制律:
68、;
69、其中,为名义等效转动惯量,为名义转矩系数,为参考累计机械角位置的二阶导数,为大于零的滑模系数,为参考累计机械角位置的时间导数,为机械角速度估计值,为第一超螺旋增益,为可实现滑模变量,为连续边界层函数,为超螺旋积分状态,为名义等效黏性摩擦系数,为负载转矩估计值;
70、将交轴电流控制律输出至电流环,驱动永磁同步电机到达目标位置。
71、本发明公开了用于移动机器人永磁同步电机的超螺旋滑模位置控制方法。获取电机累计机械角位置及三相电流,构建旋转机械方程与误差加速度方程;基于位置误差构建原始滑模变量,经归一化及双曲正切压缩得压缩误差,结合切线型屏障风险函数与耦合风险量生成主体基础增益;联合带死区、泄漏及投影的自适应附加增益形成超螺旋增益。构建超螺旋控制量并换算交轴电流分量。利用正则化有限时间扩张状态观测器估计角速度与负载转矩,更新滑模变量与增益,生成转矩补偿分量。融合各分量得交轴电流控制律驱动电机定位。本发明抑制抖振,提升响应速度、精度及鲁棒性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com