一种行星轮式越障机器人爬楼梯控制方法

摘要

本发明公开了一种行星轮式越障机器人爬楼梯控制方法，包括如下步骤：1)保持越障机器人匀速直线前进，测量其同一驱动组中两行星轮组与前方台阶的距离及行星轮组的转速，并计算偏转角；2)计算各行星轮组的理论转速，并使行星轮组以计算得出的转速进行运动；3)检测当前的L₁和L₂，并计算当前的偏转角θ；4)判断当前偏转角θ是否超过预设值：若是，则转入步骤2)，若否，则控制机器人继续等速直线前进；5)判断两行星轮组是否到达阶梯：若否，则继续等速直线前进，若是，则两行星轮组一起翻转，翻越台阶；6)判断两行星轮组是否到达目的地：若否，则重复步骤1)～5)，若是，则结束运动。本发明具有控制操作简单，转向精度高等优点。