球型机器人自平衡运动控制算法设计与研究

简介

球型机器人具有结构简单、适应性好等优点。为了提高球型机器人运动稳定性,提出利用LQR并结合PID对球型机器人的自平衡运动进行控制。利用SolidWorks建立球型机器人的三维模型并搭建相应的物理样机;利用雅可比矩阵及等效一级倒立摆模型求出机器人的运动学和动力学模型;建立PID运动位置控制算法和LQR运动倾角控制算法,设计相应的PID和LQR运动控制器;利用MATLAB/SIMULINK对所建立的PID及LQR控制器进行仿真并分析;利用所建的物理样机进行实验验证。结果表明:利用PID结合LQR所设计的运动控制器及其控制算法是准确的,有效地提高了机器人自平衡运动的控制精度及稳定性。