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

技术特征：

1.一种行星轮式越障机器人爬楼梯控制方法，其特征在于，包括如下步骤：

(1)初始状态下使越障机器人匀速直线前进，然后测量越障机器人同一驱动组中两行星轮组最前端与前方楼梯台阶的距离L₁和L₂，并测出各行星轮组的转速，根据所述L₁和L₂计算获得偏转角θ；

(2)由偏转角控制算法计算出各行星轮组的理论转速，并将计算得出的理论转速输入到各行星轮组的电机驱动器中以驱动行星轮组运动；所述由偏转角控制算法计算出各行星轮组的理论转速包括：

(2.1)首先计算越障机器人位姿调整的周期时间T：

T = k 1 × L 1 + L 2 ( ω 1 + ω 2 ) × r ; ]]>

式中：k₁为比例修正系数，ω₁,ω₂分别为行星轮组中左右两轮的转速，r为行星轮组中单个轮子的半径；

(2.2)然后计算位姿调整的幅值A：

A = k 2 θ T ; ]]>

式中：k₂为比例系数，θ为偏转角；

(2.3)再计算转速的差值：

Δ ω = A s i n ( 2 π T × t ) ; ]]>

式中：t为一周期内位姿调整经历的时间，t∈(0,T)；

(2.4)最后计算出行星轮式越障机器人同一驱动组中两行星轮组的理论转速ω₁'、ω₂'：

ω₁'＝ω₁+Δω,ω₂'＝ω₂-Δω；

(3)经过一个调整周期后检测当前的L₁和L₂，并计算当前的偏转角θ；

(4)判断当前偏转角θ是否超过预设值：若是，则转入步骤(2)，若否，则控制越障机器人继续匀速直线前进；

(5)判断越障机器人驱动组中两行星轮组是否到达阶梯：若否，则继续匀速直线前进，若是，则两行星轮组一起翻转，翻越台阶；

(6)判断两行星轮组是否到达目的地：若否，则进入新的位姿调整过程，重复步骤(1)～(5)，若是，则结束运动，以此方式完成行星轮式越障机器人爬楼梯的控制。

2.如权利要求1所述的行星轮式越障机器人爬楼梯控制方法，其特征在于，所述偏转角θ采用如下公式获得：

θ = a r c t a n L 1 - L 2 l A B ; ]]>

式中：l_AB表示越障机器人同一驱动组中两行星轮组的中心点之间的距离。

3.如权利要求2所述的行星轮式越障机器人爬楼梯控制方法，其特征在于，判断越障机器人驱动组中两行星轮组是否到达阶梯，具体为：

判断L₁和L₂是否满足如下条件：L₁＝L₂＝L_min，其中，L_min为越障机器人到达台阶时L的值。

4.如权利要求1所述的行星轮式越障机器人爬楼梯控制方法，其特征在于，所述行星轮式越障机器人为四行星轮越障机器人或六行星轮越障机器人。

5.如权利要求4所述的行星轮式越障机器人爬楼梯控制方法，其特征在于，所述行星轮式越障机器人为四行星轮越障机器人时，其设有前后两组驱动组，每组驱动组中的两行星轮组均按所述步骤(1)-(6)进行控制。

6.如权利要求4所述的行星轮式越障机器人爬楼梯控制方法，其特征在于，所述行星轮式越障机器人为六行星轮越障机器人时，其设有前中后三组驱动组，每组驱动组中的两行星轮组均按所述步骤(1)-(6)进行控制。

7.如权利要求1所述的行星轮式越障机器人爬楼梯控制方法，其特征在于，所述楼梯为螺旋楼梯或弧形楼梯。

8.如权利要求1-7任一项所述的行星轮式越障机器人爬楼梯控制方法，其特征在于，步骤(4)中所述的预设值具体为3°。