![移动机器人原理与设计(原书第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=1739583328-7GdM1FSH0yO5U0cwvr4NjzsQrZtirlam-0-5dd2f68154e815b6c15698d5fa70e53b)
式中,v为该二轮车的速度,θ为方向,(x,y)为其中心点坐标(见图2.4)。
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/2a4.jpg?sign=1739583328-IF91V4Rk4s3PbC6Wbk0zUygMPMsnKFDt-0-47dd5cba0b8d9582cac3f4662f56ba57)
图2.4 二轮车(也称为Dubins小车)
状态向量为x=(x,y,θ,v)。在此,想设计一个控制器来描述如下方程所示的一条摆线:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t4.jpg?sign=1739583328-ywf6wmaCveTiSj1kOLClP5Ay7EbAwgEg-0-ae8b3fbb80d580000090ce66bc33be3f)
其中,R=15,f1=0.02且f2=0.12。基于此,利用一个反馈线性化方法,可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t5.jpg?sign=1739583328-aY4NLfzd1qzixa9Ygm9vrH5uHrtk7BxB-0-dcc4fc47bf410aca8e142db94918f4d7)
如果将输入看作:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/52t6.jpg?sign=1739583328-bZEKhwHHd8rrBQw5qBND9NYwLxAsaWY8-0-8fca294fbc6ae46e9162798b948df75d)
式中,(v1,v2)为新输入向量,则可得到如下线性系统:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t1.jpg?sign=1739583328-30NbsIdyXkLdKTHotuop2Y5ddT2XDlFJ-0-e3c17fdf12d58f1830d73d2de84afcef)
转换该方程以使方程的所有极点变为-1,则由式(2.2)可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t2.jpg?sign=1739583328-DQTN5LTtBsfwOoOi0sOmyilFHDNeZXke-0-58eb80763b1d75781b69bb4d43d182a4)
那么,转换后的方程服从如下微分方程:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t3.jpg?sign=1739583328-setUfeKOaB2KLlKd4i66wFLPewMOu9Qf-0-fc808c051c42a4512720d5799169d1c5)
如果,将误差向量定义为e=(ex,ey)=(xd-x,yd-y),则可将误差的动态特性写为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t4.jpg?sign=1739583328-P7wq65bZEOzkgJL1dsHC7NKLjPOMESNp-0-658e20b0ee936cac68a9526b1b5bb87a)
上式稳定而快速地收敛于0。因此,控制器为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t5.jpg?sign=1739583328-YWq2FplfqYEYitniJbQk1Czatb34nPhd-0-68aaf0e1373a9d8f5299750d90038979)
其中,
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/53t6.jpg?sign=1739583328-htr4zIt6OmehvoyRfPHpwhTZOwd5vsD4-0-a4bce898a58ace292b046374f65769f6)