![移动机器人原理与设计(原书第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=1738874569-nWecN2Lo7tGs3rgvKKevP57Z2GNubnvG-0-74a4836f8f02564474a23088d6996c28)
式中,v为该二轮车的速度,θ为方向,(x,y)为其中心点坐标(见图2.4)。
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/2a4.jpg?sign=1738874569-0AsQBeogkkrctCq6kKovmAwbxmeHDpJb-0-1c1e397133207a2c91130344bdd2c7c5)
图2.4 二轮车(也称为Dubins小车)
状态向量为x=(x,y,θ,v)。在此,想设计一个控制器来描述如下方程所示的一条摆线:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t4.jpg?sign=1738874569-My0aFIbRNnvLjYwpE4UWkOqTMDPweH0B-0-7be46d2d43d9fcad63da3a935fb47495)
其中,R=15,f1=0.02且f2=0.12。基于此,利用一个反馈线性化方法,可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t5.jpg?sign=1738874569-fI1SraWPOvsZOnmliDe9jJAmn69LJbZh-0-ec850d2179a849e2df43fda6d4ebe8a5)
如果将输入看作:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t6.jpg?sign=1738874569-VYORBjroO8D0ngLHGcrbHz2cCK6PtzYi-0-38cbcc9bad39c20a0a906988d16b12cd)
式中,(v1,v2)为新输入向量,则可得到如下线性系统:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t1.jpg?sign=1738874569-8GUQYtyEd5gII7tXsr7ZujoOgPyRzuYK-0-f93613233413edb42cd562bb27f0cd46)
转换该方程以使方程的所有极点变为-1,则由式(2.2)可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t2.jpg?sign=1738874569-AkyP1ft84kTHVA01evbmLKJ6JFfSFTVG-0-13ac5a147f6080b41c89f53ae6cac902)
那么,转换后的方程服从如下微分方程:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t3.jpg?sign=1738874569-ot9Va216NevpZkaccWRSp6VP2uGx1DPv-0-9357acef19bba186a57cc490e4fe049b)
如果,将误差向量定义为e=(ex,ey)=(xd-x,yd-y),则可将误差的动态特性写为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t4.jpg?sign=1738874569-bfPW15E2go1gnPivQvFIxTKH0x8NEdPG-0-b50be6baa7bee1bb6fcb78ff216f82ac)
上式稳定而快速地收敛于0。因此,控制器为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t5.jpg?sign=1738874569-xige0DnnnfMmVYMMpsUlar6WTDMpjQYN-0-d9b5580b1dfa93d615db3df9e8a863f6)
其中,
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t6.jpg?sign=1738874569-8z5brLKiMqktxfKv7ANzAxzuoST8tOxE-0-cdff5baf628f0b31af9389c84bfb87a6)