![移动机器人原理与设计(原书第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=1739582527-d6pVJ1WmCv6ELmkKkovCp4NL5PWsvMa8-0-ff281c3643f371345f686a604feaa833)
式中,v为该二轮车的速度,θ为方向,(x,y)为其中心点坐标(见图2.4)。
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/2a4.jpg?sign=1739582527-aVBpjBZe0OxFCFMMLwUHwR6yBQ12H1rY-0-a7161237a9158da97f6d70a85c7f493c)
图2.4 二轮车(也称为Dubins小车)
状态向量为x=(x,y,θ,v)。在此,想设计一个控制器来描述如下方程所示的一条摆线:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t4.jpg?sign=1739582527-OIn5UHGT3Vrx0knz8sBupWQKf9rv8Vr1-0-30fb988ae33a379de3924c644d336fad)
其中,R=15,f1=0.02且f2=0.12。基于此,利用一个反馈线性化方法,可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t5.jpg?sign=1739582527-cNzwlEqyeeBFmc5oz3JtD7GP3hidMxu3-0-03996185b0d5470f8b4b71fdb113f09b)
如果将输入看作:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t6.jpg?sign=1739582527-mC43TIH1jwjVXWOEftZZGbZFZrw2tQEk-0-9557c8a655e8d2b7a5c190494eacff1b)
式中,(v1,v2)为新输入向量,则可得到如下线性系统:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t1.jpg?sign=1739582527-3IDrmtWu15S1ViNWSmSQvl3INoySwb1B-0-0258c85d18b09aec6394c5722bd0f07a)
转换该方程以使方程的所有极点变为-1,则由式(2.2)可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t2.jpg?sign=1739582527-YReGeW0WIoYEGUVMI0aHYEiGSyetXt3j-0-10a79921d22aebae4d9b884d87b97715)
那么,转换后的方程服从如下微分方程:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t3.jpg?sign=1739582527-dnljvaVBHkvKLUEsen2c6ZIvBgGxWnTF-0-4b6582d8d633116f8bfa84c2f84cd505)
如果,将误差向量定义为e=(ex,ey)=(xd-x,yd-y),则可将误差的动态特性写为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t4.jpg?sign=1739582527-xWIsW3wIWoluNGhb1LtVAxdBTjPbT6jW-0-55229da9dbd81b9fd702565deea1a001)
上式稳定而快速地收敛于0。因此,控制器为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t5.jpg?sign=1739582527-R7leD7O0OHlg7tagrhh3ZbvC9UbknAPW-0-21257d2fd60c2c6c1334358bf12f0f56)
其中,
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t6.jpg?sign=1739582527-iN4T3YDkQwHRoUeIkaLTEqNJ175a1ovI-0-edf3909aeb2b3f3069d07e274f995dbe)