平衡摇臂式移动机器人姿态控制算法

摘要

以具有平衡摇臂机构的移动机器人为研究对象,设计一种基于非线性规划遗传算法的姿态控制算法,提高越障过程中工作平台的平稳性.首先简化平衡摇臂机构并定义表征移动机器人空间状态的姿态参数.利用空间机构学位姿变换方程推导出所定义的空间姿态参数与轮心相对位置之间的数学关系.然后设计非线性规划遗传算法,以移动机器人稳定性条件为约束设计遗传算法适应度函数并求解目标姿态控制参数.为验证所设计的姿态控制算法,在ADAMS软件中搭建移动机器人三维模型和障碍路面模型,并联合MATLAB/Simu-link对移动机器人进行了运动学仿真.仿真结果表明在该姿态算法的控制下,与不施加主动姿态控制相比较,移动机器人通过搭建的障碍路面时最大侧倾角由10.8°降低到了1.8°,质心高度变化幅值度由96.4 mm降低到了34.9 mm,证明了姿态控制算法的有效性.%In order to improve the stability of working platform in the process of obstacle negotiation,with balancing-arm mobile robot as research object,an attitude control algorithm was designed based on nonlinear programming genetic algorithm.First,the simplified model of balancing-arm mechanism was built and spatial posture parameters were defined to character the space state of robot.Mathematical relationship between spa-tial posture parameters and wheel center positions was deduced by coordinate transformation equation based on spatial mechanism.Then,a nonlinear programming genetic algorithm was designed.The genetic algorithm fit-ness function used to solve objective control parameters was established under the constraint of stability.To verify the performance of the proposed attitude control algorithm,3D model of the mobile robot and road were built in the ADAMS software,and then kinematics simulation studies were carried out by ADAMS and MAT-LAB/Simulink.The results of simulation show that when balance-arm mobile robot passes through the de-signed obstacles with the designed controller,the roll angle falls from 10.8°to 1.8°compared with no control-ler and the amplitude of wheel center position falls from 96.4 mm to 34.9 mm as also.The simulation results demonstrate the validity of the proposed attitude control algorithm.