Answers:
最简单的控制器是线性状态反馈控制器。您实际上需要获得4种不同的状态。这些是倾斜角度,倾斜速率,速度和位置。
LQR(线性二次调节器)是一种设计这些增益的方法(在获得系统的线性化状态空间表示之后)。如果没有状态空间表示(可能没有),则可以获取运动方程并测量参数。如果没有状态空间表示,则应手动调整增益(不使用LQR或其他方法,如极点放置)。
假设倾角,位置/速度和车轮扭矩都向前(如果为正),则您希望倾角和倾角率获得正增益,而位置和速度也获得正增益。
首先要获得倾斜角和倾斜率。这将使它最初保持平衡。一旦保持平衡,就可以通过增加增益来控制位置和速度。如果不稳定,请增加倾斜速率的增益(这有助于阻尼系统)。
位置/速度控制将两种状态都控制为零。要控制其他值,您只需要一个参考跟踪控制器即可,在将状态输入错误之前将其状态替换为它们的错误(例如,当前速度-速度参考)。
偏航控制可以独立进行(将车轮扭矩的差异添加到主平衡/速度/位置控制器中)。