![移动机器人原理与设计(原书第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=1739283863-zKh5COPAAzLyelhpOJd4HS3b2rPTUkHO-0-0dc45f6f92754b91e9decdbb306442e2)
式中,v为该二轮车的速度,θ为方向,(x,y)为其中心点坐标(见图2.4)。
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/2a4.jpg?sign=1739283863-ohsi8R64OosJQ0laUOmQzzWBSzhLa4w1-0-955c94f7079bd55ea2bb5614d6aeaa7d)
图2.4 二轮车(也称为Dubins小车)
状态向量为x=(x,y,θ,v)。在此,想设计一个控制器来描述如下方程所示的一条摆线:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t4.jpg?sign=1739283863-z763n9NVtt6MXyiemD8rP0usLn4C93Ic-0-fc318c8ccf3753da2314ef200707eac5)
其中,R=15,f1=0.02且f2=0.12。基于此,利用一个反馈线性化方法,可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t5.jpg?sign=1739283863-Er5vHQXViHteEVb6R4KGuInREWZBeHel-0-e34674b4bf5f7411736d104fbd19fd95)
如果将输入看作:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t6.jpg?sign=1739283863-0W8V88nJ1M7ebgyHzJHPHVNmXi70dppG-0-6dc849915ff499bb223188286ec6dd3d)
式中,(v1,v2)为新输入向量,则可得到如下线性系统:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t1.jpg?sign=1739283863-RR5xwJHrW4luAXx4wbXWhGcbHDUKfNqC-0-9705cfb5a66ec6c67df6e3d73a9a3945)
转换该方程以使方程的所有极点变为-1,则由式(2.2)可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t2.jpg?sign=1739283863-7jVEJqq5yQZctV9SHMrydDgOCj3ykkA9-0-02c4f1aec0b902690668d01626300095)
那么,转换后的方程服从如下微分方程:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t3.jpg?sign=1739283863-vATnVzC2k5P6aLUd9GlxRCLCnXPPkpPg-0-06d5ebee89b4d74dcd49627a736afcab)
如果,将误差向量定义为e=(ex,ey)=(xd-x,yd-y),则可将误差的动态特性写为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t4.jpg?sign=1739283863-GvbQdnljWHR8vIEVqvuBEUNsQ3cC01nd-0-d6269d0e2b6c9df294fad9948a721d9f)
上式稳定而快速地收敛于0。因此,控制器为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t5.jpg?sign=1739283863-kr3XVQ6x5uXUmrI48ogYYhk8sHx7H7bC-0-a6f8826722bf2c6c47be12ebbc137586)
其中,
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t6.jpg?sign=1739283863-8xHDUfE2uqArWrdPFe04Oen9NvTuY7HJ-0-9e4b9e0dc1c761ec1ac067f7a77f4422)