机器人动力学与控制学习笔记(十七)——基于名义模型的机器人滑模控制

十七、滑模控制器设计原理

        滑模运动包括趋近运动和滑模运动两个过程。系统从任意初始状态趋向切换面,直到到达切换面的运动称为趋近运动,即趋近运动为s\rightarrow 0的过程。根据滑模变结构原理,滑模可达性条件仅保证由状态空间任意位置运动点在有限时间内到达切换面的要求,而对于趋近运动的具体轨迹未作任何限制,采用趋近律的方法可以改善趋近运动的动态品质。

17.1  基于名义模型的机器人趋近律设计

        二力臂机械手的名义模型为

M\left ( q \right )\ddot{q}+H\left ( q,\dot{q} \right )=\tau

        其中M\left ( q \right )2\times 2正定质量惯性矩阵,H\left ( q,\dot{q} \right )为哥氏力,离心力和重力之和。

        实际对象为

\left ( M+\Delta M \right )\ddot{q}+\left ( H+\Delta H \right )=u+\Delta u

        将建模误差、参数变化及其他不确定因素视为外界扰动f(t),则

M\left ( q \right )\ddot{q}+H\left ( q, \dot{q}\right )=u+f\left ( t \right )

        其中

f(t)=\Delta u-\Delta M\ddot{q}-\Delta H

        系统误差为

e=\begin{bmatrix} e_{1} & \dot{e_{1}} & e_{2} & \dot{e_{2}} \end{bmatrix}^{T}

切换函数为

s(x)=Ce=\begin{bmatrix} c_{1}e_{1}+\dot{e_{1}}\\ c_{2}e_{2}+\dot{e_{2}} \end{bmatrix}

        则

\dot{s}=\begin{bmatrix} c_{1}\dot{e_{1}}+\ddot{e_{1}}\\ c_{2}\dot{e_{2}}+\ddot{e_{2}} \end{bmatrix}=\begin{bmatrix} c_{1}\dot{e_{1}}\\ c_{2}\dot{e_{2}} \end{bmatrix}+\begin{bmatrix} \ddot{\theta }_{1}^{d}\\ \ddot{\theta }_{2}^{d}\end{bmatrix}+\begin{bmatrix} \ddot{\theta }_{1}\\ \ddot{\theta }_{2}\end{bmatrix}=\begin{bmatrix} c_{1}\dot{e_{1}}\\ c_{2}\dot{e_{2}} \end{bmatrix}+\begin{bmatrix} \ddot{\theta }_{1}^{d}\\ \ddot{\theta }_{2}^{d}\end{bmatrix}-M^{-1}\left ( u+f-H \right )

        取指数趋近律为

\dot{s}=-\varepsilon sgn(s)-ks=\begin{bmatrix} -\varepsilon_{1} sgn(s_{1})-ks_{1}\\ -\varepsilon_{2} sgn(s_{2})-ks_{2} \end{bmatrix}

        经过整理,得到控制律为

u=M\left \{ \begin{bmatrix} c_{1}\dot{e_{1}}\\ c_{2}\dot{e_{2}} \end{bmatrix} +\begin{bmatrix} \ddot{\theta _{1}^{d}}\\ \ddot{\theta _{2}^{d}} \end{bmatrix}+\varepsilon sgn(s)+ks\right \}+H-f

17.2  仿真实例

17.2.1  单关节机器人仿真

        单关节机器人的动态方程为

\ddot{q}+25\dot{q}=133u+f(t)

        取位置指令为r,simulink结构图、力矩图和仿真结果如图1,2,3所示。

机器人动力学与控制学习笔记(十七)——基于名义模型的机器人滑模控制_第1张图片

 图1 simulink结构图

机器人动力学与控制学习笔记(十七)——基于名义模型的机器人滑模控制_第2张图片

 图2 单关节力矩

机器人动力学与控制学习笔记(十七)——基于名义模型的机器人滑模控制_第3张图片

 图3 单关节轨迹

17.2.2  二关节机器人仿真

        二关节机器人系统的动力学模型为

M\left ( q \right )\ddot{q}+C\left ( q,\dot{q} \right )\dot{q}+G\left ( q \right )=\tau +f\left ( t \right )

        二关节的位置指令分别为q_{1d}q_{2d},simulink结构图和仿真结果如图4,5,6所示。

机器人动力学与控制学习笔记(十七)——基于名义模型的机器人滑模控制_第4张图片

图4 simulink结构图 

机器人动力学与控制学习笔记(十七)——基于名义模型的机器人滑模控制_第5张图片

图5 关节1轨迹

机器人动力学与控制学习笔记(十七)——基于名义模型的机器人滑模控制_第6张图片

 图6 关节2轨迹

         经分析,所设计的控制律和控制器均符合要求,机器人关节的实际轨迹和期望轨迹较为贴合,仿真效果好。

你可能感兴趣的:(机器人,学习,笔记)