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

其它领域

本发明公开了一种行星轮式越障机器人爬楼梯控制方法，包括 如下步骤:1)保持越障机器人匀速直线前进，测量其同一驱动组中两 行星轮组与前方台阶的距离及行星轮组的转速，并计算偏转角;2)计算各行星轮组的理论转速，并使行星轮组以计算得出的转速进行运动; 3)检测当前的 L1 和 L2，并计算当前的偏转角θ;4)判断当前偏转角θ 是否超过预设值:若是，则转入步骤 2)，若否，则控制机器人继续等 速直线前进;5)判断两行星轮组是否到达阶梯:若否，则继续等速直 线

产业化应用