差速轮机器人由于其简洁的结构、较大的负载、较长的续航时间在仓储物流行业中有较多的应用。其中运动控制作为基础的功能之一是保证安全可靠运行的基础,以李雅普诺夫稳定为依据设计的运动控制器对差速轮机器人运行的平稳性有较好的效果。

运动学模型分析

 

图1


  差速轮机器人的运动学模型如图1所示,r rr 表示机器人中心距离目标位姿的长度,δ \deltaδ表示机器人方向与r rr所成的角度,θ \thetaθ与r rr所成的角度,其状态方程如下:

从状态方程(1)中可以看出r rr和θ \thetaθ与线速度v vv相关,因此在通过李雅普诺夫稳定设计控制器时先保证r rr和θ \thetaθ稳定,再设计w ww使得δ \deltaδ稳定。

控制率原理推导

  通过李雅普诺夫稳定性判据可知如果能找到一个正定的由状态变量组成的函数(李雅普诺夫函数),且函数的一阶导为负定,则系统是渐进稳定的。
  李雅普诺夫函数设计如式(2)所示。

李雅普诺夫函数对时间的一阶导如式(3)所示。

渐进稳定的,重新定义一个李雅普诺夫函数,如式(4)所示。

(4)

得式5。

因此机器人角速度w的控制率为:

注意事项

  1. 参数k 1,k 2 >0;
  2. 在跟踪取消的时候,目标点随着机器人位置发生变化,目标点与机器人的速度相关;
  3. 当机器人接近目标点时,存在奇点的情况;