![移动机器人原理与设计(原书第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=1739280543-S6WnZElNmbvun5CvH68aJMImxjqSGfig-0-282c781f64564b0286f4efa7cad259ee)
式中,v为该二轮车的速度,θ为方向,(x,y)为其中心点坐标(见图2.4)。
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/2a4.jpg?sign=1739280543-KIibJZJ7Lgi0ZTg4BfPIxd485JwMMAYJ-0-5f0f7c240ba406518bc4542234073b56)
图2.4 二轮车(也称为Dubins小车)
状态向量为x=(x,y,θ,v)。在此,想设计一个控制器来描述如下方程所示的一条摆线:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t4.jpg?sign=1739280543-tBfIFz3oi63G2AQOkJ4QR9ISU73Ty5pS-0-4bd6f220a30adb278ebf2c607d038b15)
其中,R=15,f1=0.02且f2=0.12。基于此,利用一个反馈线性化方法,可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t5.jpg?sign=1739280543-ZLjGhpajBVx1G9qaG4qel0VOZFCyl5tz-0-457b82d1de1113e04e0e4be96fa32368)
如果将输入看作:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t6.jpg?sign=1739280543-VPFfWWTe8wCDQte4vxWq9u3kdW4SLmYf-0-db5361719d3ad389676d33650871f158)
式中,(v1,v2)为新输入向量,则可得到如下线性系统:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t1.jpg?sign=1739280543-XDKaxiitvbcCRO3VeJGy4mpWuiSOuNWz-0-9200b00b5da18171a95fae2eda723217)
转换该方程以使方程的所有极点变为-1,则由式(2.2)可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t2.jpg?sign=1739280543-5ju5KfB7bIE5th00VScLyBPEZzzf6WVq-0-fd5a252a86f337b91c1a3f10c3e4ed44)
那么,转换后的方程服从如下微分方程:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t3.jpg?sign=1739280543-NbdmRAUDx90FbMZg9MRj8KG7gHGcry7U-0-7aff3959bd3c44b5e09848bfb81d0a5b)
如果,将误差向量定义为e=(ex,ey)=(xd-x,yd-y),则可将误差的动态特性写为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t4.jpg?sign=1739280543-84DYScPrpistxKMnQUhmsGGaMPBsWwWC-0-f53373818aae6fdfd0d7711851bf1a41)
上式稳定而快速地收敛于0。因此,控制器为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t5.jpg?sign=1739280543-XOjWMjJ02dN5NLhPpSfzvFfc4rFwV3rq-0-881f8a1b7a680e21d5d1c35a01eb26f9)
其中,
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t6.jpg?sign=1739280543-aj1z8prFrrTtg0hLu8MkqMAWII31Bq5R-0-fd73c464ad72f68daaf67ee4bbae80dc)