带有导臂的履带式移动机器人的攀爬楼梯控制方法

摘要

带有导臂的履带式移动机器人的楼梯攀爬方法，其特征在于：步骤1：机器人驶近楼梯，导臂向下旋转，在与楼梯踏步接触后机器人被抬起，并向前攀爬楼梯，当机器人上的超声、红外测距传感器测得机器人与前方物体距离大于楼梯踏步的宽度时，认为机器人已攀爬至楼梯顶部，停止攀爬。步骤2：导臂向下旋转，直到导臂前端与地面接触，当导臂的旋转轴上产生转矩M大于设定值时，导臂停止转动，机器人继续向上攀爬，导臂随机器人的攀爬而与地面脱离，转矩M消失，机器人停止攀爬。步骤3：重复步骤2，二维姿态传感器测得的车体与水平面夹角随机器人攀爬而减小，机器人继续攀爬至所述夹角不再减小时，停止攀爬，导臂向后旋转，与车体的夹角θ为45度时停止转动。