![移动机器人原理与设计(原书第2版)](https://wfqqreader-1252317822.image.myqcloud.com/cover/158/41517158/b_41517158.jpg)
上QQ阅读APP看书,第一时间看更新
2.1.1 比例–微分控制器
首先,利用一个如下形式的比例–微分控制器稳定该系统:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/45t2.jpg?sign=1739673017-cTcRUXF9QE0jzulj1JuZ9sIXqZ8gKBlp-0-6a502e0acd154273cc12c13b819979b2)
式中,w为y的期望值。值得注意的是,w可能是依赖于时间的。显而易见,该控制器需要y的微分,这在反馈线性化所定义的结构内并不存在任何问题。当然,可以将这些微分量表示为关于系统状态变量x和输入变量u的解析方程。至于期望值w(t),则可人为选择,并假设其解析表达式是已知的(例如:w(t)=sin(t))。如此而言,就可以用正规方式去计算w的微分而不用担心噪声对微分算子的影响。
该反馈系统由如下微分方程描述:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/45t3.jpg?sign=1739673017-BRtFWcZVt8mbnMYfjurI1muZnr2LGaX0-0-ac56efb8c42a14fe411dc04687188bd3)
如果定义期望值w与输出y之间的误差e为e=w-y,则该方程可转化为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/45t4.jpg?sign=1739673017-kVh4PnYQjCYHymx8133O3uuu9tWAfXYd-0-92b858fc301e946421186ae2fbfef239)
将该微分方程称为误差动态方程。其特征多项式为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/45t5.jpg?sign=1739673017-5DadBlB9TM9CbKsLyi7iaNtGsMLACoaM-0-81436ce80a540a44d000c2971e6e00b5)
那么,便可根据多项式的次数任意选择特征多项式。当然,为保证系统的稳定性,多项式的所有根均应具有负实部。例如,假定n=3且方程的所有极点都等于-1,则有:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/45t6.jpg?sign=1739673017-8H1rwjZhpnYsgkqqdsBP8dOjvfMdNrVy-0-f72af5ef142a289cc2d58cce44f47c0b)
其中,
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/45t7.jpg?sign=1739673017-QRoFEfKCXziRdxWMtc47ZYiUqMGvGWU1-0-663770b242f9ad25f868918bb5379d2f)
则所得控制器如下式所示:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/45t8.jpg?sign=1739673017-RQxuxmMvUwwy1lSAvORMGrNEx8LeNDD5-0-b5af177e862b230c93bd8b28b2507c71)
注释 在本书中,为简化起见,将所有的极点都选择为-1。根据之前应用于不同次数n的推论,可得如下控制:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/45t9.jpg?sign=1739673017-yYtAxryR6xogxZMAZ6pntaM8h8CPKUvp-0-60118f707021eccd7b2fd7dcf08ffde8)
注意,对应于这类帕斯卡三角形的系数为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/45t10.jpg?sign=1739673017-QWSGEt3a4AVagtkCLO6o7pG6xezTIbiK-0-17abff141f56ecdaea30308bc89e796e)