一种麦克纳姆轮全向移动机器人轨迹跟踪滑模控制方法与流程

技术特征：
1.一种麦克纳姆轮全向移动机器人轨迹跟踪滑模控制方法，其特征是，包括有以下步骤：s1、选取机器人运动平面上任意一点为原点，建立全局坐标系、选取机器人的几何中心为原点建立连体坐标系；s2、定义连体坐标系中的运动学模型并获得连体坐标系中机器人的位姿坐标；定义在全局坐标系下机器人的位姿，通过连体坐标系到全局坐标系间的旋转矩阵，建立全局坐标系中的运动学模型；s3、建立驱动电机与机器人的麦克纳姆轮车轮相关的系统模型；s4、给出机器人运动的二维平面上规划的期望位姿，得到跟踪位姿误差，建立滑模面；s5、设计多幂次趋近律，设计驱动电机的力矩作为系统的控制输入，得到控制律；s6、将得到的控制输入传递至s3中建立的系统模型，解算机器人下一时刻的状态信息，由当前时刻更新至下一时刻；s7、重复步骤s2
‑
s6，到达跟踪路径终点或跟踪上目标物后，结束计算。2.根据权利要求1所述的麦克纳姆轮全向移动机器人轨迹跟踪滑模控制方法，其特征是，连体坐标系与全局坐标系及其对应运动学模型的建立具体为：选取机器人运动平面上任意一点作为全局坐标系原点o
h
，以正东方向为横轴x
h
，正北方向为纵轴y
h
，建立全局坐标系x
h
o
h
y
h
；以机器人的几何中心为原点o
r
，以向右方向为横轴x
r
、向前方向为纵轴y
r
，建立连体坐标系x
r
o
r
y
r
；定义连体坐标系x
r
o
r
y
r
中的运动学模型在连体坐标系x
r
o
r
y
r
中：机器人的位姿坐标为其中[x
r y
r
]
t
是机器人的位置坐标，是机器人的转角，故机器人的速度矢量定义车轮半径为r,车轮的角速度为ω
i
，i＝1，2，3，4；定义车体左右轮中心距为2a，上下轮中心距为2b；在全局坐标系x
h
o
h
y
h
下，定义机器人的位姿为x
h
轴和x
r
轴之间的夹角为r表示小车的半径，a和b分别表示机器人平台的宽度和长度的一半，θ
i
为第i个轮子的转角，为第i个轮子的转速；连体坐标系x
r
o
r
y
r
到全局坐标系x
h
o
h
y
h
之间的旋转矩阵为建立全局坐标系x
h
o
h
y
h
中模型：
式中3.根据权利要求2所述的麦克纳姆轮全向移动机器人轨迹跟踪滑模控制方法，其特征是，建立驱动电机与机器人的车轮相关的系统模型为：式中i0为车轮等效转动惯量，η0为车轮与地面的粘性摩擦系数，τ＝[τ
1 τ
2 τ
3 τ4]
t
为外界不确定性扰动，u＝[u
1 u
2 u
3 u4]
t
为电机的力矩输入；且有：4.根据权利要求3所述的麦克纳姆轮全向移动机器人轨迹跟踪滑模控制方法，其特征是，步骤s4具体为：给出麦克纳姆轮全向移动机器人运动的二维平面上规划期望位姿为得到跟踪位姿误差向量q
e
；设计比例
‑
微分形式的滑模面向量如下：其中，5.根据权利要求4所述的麦克纳姆轮全向移动机器人轨迹跟踪滑模控制方法，其特征是，步骤s5中设计多幂次趋近律，得到控制律具体为：定义趋近律：式中α＞1，0＜β＜1，σ＞0，ε＞0，k＞0；
设计驱动电机的力矩作为系统的控制输入u：其中，其中，其中，

技术总结
本发明公开了一种麦克纳姆轮全向移动机器人轨迹跟踪滑模控制方法，解决了一般控制方法在控制过程中易出现收敛速度慢、耗时长，且存在抖振的问题，其技术方案要点是包括以下步骤，建立全局坐标系和连体坐标系，获取各坐标系下的运动学模型，建立驱动电机与车轮相关的系统模型，建立滑模面，设计多幂次趋近律得到控制律，将驱动电机的力矩输入作为控制输入，并代入系统模型解算状态信息进行更新，重复直至达到设定条件结束计算，建立以电机力矩为控制输入到机器人三自由度位姿为输出的四输入三输出过驱动数学模型，本发明的麦克纳姆轮全向移动机器人轨迹跟踪滑模控制方法能提高跟踪控制系统的稳定性，提高收敛速度，动态响应过程更加平滑。过程更加平滑。过程更加平滑。


技术研发人员：张爱华 杨凌耀 宋季强
受保护的技术使用者：上海工程技术大学
技术研发日：2021.08.02
技术公布日：2021/10/8