移动机器人原理与设计(原书第2版)
上QQ阅读APP看书,第一时间看更新

2.4 二轮车

2.4.1 一阶模型

考虑一个由如下状态方程所示的二轮车:

式中,v为该二轮车的速度,θ为方向,(x,y)为其中心点坐标(见图2.4)。

图2.4 二轮车(也称为Dubins小车)

状态向量为x=(x,y,θ,v)。在此,想设计一个控制器来描述如下方程所示的一条摆线:

其中,R=15,f1=0.02且f2=0.12。基于此,利用一个反馈线性化方法,可得:

如果将输入看作:

式中,(v1,v2)为新输入向量,则可得到如下线性系统:

转换该方程以使方程的所有极点变为-1,则由式(2.2)可得:

那么,转换后的方程服从如下微分方程:

如果,将误差向量定义为e=(ex,ey)=(xd-x,yd-y),则可将误差的动态特性写为:

上式稳定而快速地收敛于0。因此,控制器为:

其中,