[发明专利]一种基于LQR算法的两轮机器人平衡控制器

权利要求书

1.一种基于LQR算法的两轮机器人平衡控制器，包括以下步骤：根据牛顿经典力学分析法建立两轮机器人的非线性模型如下：

x··(M+2m+2JωR2)+ML(θ··cosθ-θ·2sinθ)=1R(Cl+Cr)---(1)]]>

Jpθ··=MgL sinθ-ML2θ·2sinθcosθ-ML2θ··sin2θ-(1+L cosθR)(Cl+Cr)+2L(m+JωR2)cosθ·x··---(2)]]>

(Dm+2JδD+DJωR2)δ··=1R(Cl-Cr)---(3)]]>

由于存在非线性因素，控制难度系数大较，故本文针对机器人的非线性模型进行线性化处理，模型如下：

x··(M+2m+2JωR2)+MLθ··=1R(Cl+Cr)---(4)]]>

JPθ··=MgLθ-(1+LR)(Cl+Cr)+2L(m+JωR2)·x··---(5)]]>

(Dm+2JδD+DJωR2)δ··=1R(Cl-Cr)---(6)]]>

再将线性化方程转换成矩阵形式：

M+2m+2JωR2ML0-2L(m+JωR2)JP000Dm+2JδD+DJωR2x··θ··δ··=01R1RMgL-(1+1R-(1+1R)01R1RθClCr]]>

其中，M为车体重量，m为车轮重量，J_ω为车轮对轮轴转动惯量，J_θ为车轮对z轴转动惯量，J_θ为车轮对y轴转动惯量，R为车轮半径，D为车轮间距，L为Z轴到车体质心的距离，C为输入转矩。

根据矩阵形式看出，看出系数矩阵A是分块对角矩阵，即表明关于平衡与速度控制的4个状态变量与关于转向控制的2个状态变量无关，因此为了便于理论分析，本文利用解耦方法对线性化方程的矩阵形式进行解耦处理，并代入相关参数得如下两个子系统：

平衡与前进系统：

x·x··θ·θ··=010000-23.7097000010083.77420xx·θθ·+01.83320-4.9798Cθ---(7)]]>

转向系统：

δ·δ··=0100δδ·+05.1519Cδ---(8)]]>

本文重点研究两轮机器人的平衡控制问题，即根据上述式(7)设计平衡控制器，再利用MATLAB仿真分析平衡控制的效果。