![移动机器人原理与设计(原书第2版)](https://wfqqreader-1252317822.image.myqcloud.com/cover/158/41517158/b_41517158.jpg)
上QQ阅读APP看书,第一时间看更新
2.4 二轮车
2.4.1 一阶模型
考虑一个由如下状态方程所示的二轮车:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t3.jpg?sign=1739670275-Tc1z1VKEsuAemVpscrQ0wkxoqw32FMGd-0-fad0ce187986fad3ff0d8b20e4966722)
式中,v为该二轮车的速度,θ为方向,(x,y)为其中心点坐标(见图2.4)。
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/2a4.jpg?sign=1739670275-BqKmjRRSDhB6owVwLgBbGavSTJYd75LF-0-52dbeb6f483dd59db0ee8af1e8b5e93d)
图2.4 二轮车(也称为Dubins小车)
状态向量为x=(x,y,θ,v)。在此,想设计一个控制器来描述如下方程所示的一条摆线:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t4.jpg?sign=1739670275-WSd4cOvpyKb4OIWyixctbCE5K7NljDRD-0-999c123f572c4fb223596f935922f3c3)
其中,R=15,f1=0.02且f2=0.12。基于此,利用一个反馈线性化方法,可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t5.jpg?sign=1739670275-IhNDIubohHOKdQze6L2IcG6E8Zb3tBNZ-0-8f10c9d4ed255d8f96daa9172efcf010)
如果将输入看作:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t6.jpg?sign=1739670275-obFXCqlfQ22iNVkgqhlnHpNJGGE7g9vl-0-aa5002112dd222dbb28bd790070dfba1)
式中,(v1,v2)为新输入向量,则可得到如下线性系统:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t1.jpg?sign=1739670275-fyH5P3ITI2slIECk6y8kukSy1Bl1ggeR-0-5aa0bca2bdbfe450fd815ea273cd6618)
转换该方程以使方程的所有极点变为-1,则由式(2.2)可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t2.jpg?sign=1739670275-yZXDaacLuHOxSP1Cq3dsAFDokL7v1AOi-0-bc60afeba77c72a73099f59a1ff93ba0)
那么,转换后的方程服从如下微分方程:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t3.jpg?sign=1739670275-IKR4KPxDth12p3TFBD6h6LhnaevnzzTO-0-bf3dc49cf27adf5d59668ebc4d289dd1)
如果,将误差向量定义为e=(ex,ey)=(xd-x,yd-y),则可将误差的动态特性写为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t4.jpg?sign=1739670275-dYS4XyjDZZSNpC8NaS2792uOxIbe3vXb-0-0be65993f1b47452d1389dd721f62bef)
上式稳定而快速地收敛于0。因此,控制器为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t5.jpg?sign=1739670275-QhDERGeMfSDJn7AOJzbkOw5OmAMdCqSP-0-090ecf0747426b5f1f68676ca30d3407)
其中,
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t6.jpg?sign=1739670275-WlUVPXhiarw6N8jhrSR8hI58VWUMqCyL-0-1962e7c4f7fca0aeb0502c81fe963ef1)