[发明专利]两轮轮式机器人点镇定增量式智能控制方法

权利要求书

1.两轮轮式机器人点镇定增量式智能控制方法，其特征在于，采用增量式控制器控制两轮轮式机器人的左轮期望轮速和右轮期望轮速；所述增量式控制器分为两级，分别为任务适应级和运行控制级；其具体包括如下控制步骤：

a)获取当前控制周期时，机器人所在点与目标点的距离偏差e_d(k)，以及机器人朝向与机器人由所在点面向目标点方向的角度偏差e_θ(k)；k表示当前控制周期；

b)在任务适应级，根据距离偏差e_d(k)和角度偏差e_θ(k)，采用广义的比例控制，获得当前控制周期的左轮期望轮速适应值u_Lc(k)和右轮期望轮速适应值u_Rc(k)；

c)在运行控制级，根据任务适应级获得的左轮期望轮速适应值u_Lc(k)和右轮期望轮速适应值u_Rc(k)，采用增量式轮速跟随控制，获得当前控制周期的左轮期望轮速u_L(k)和右轮期望轮速u_R(k)；其具体操作包括：

c1)获取左轮轮速饱和增量ΔU_Lmax和左轮轮速饱和值U_Lmax，以及右轮轮速饱和增量ΔU_Rmax和右轮轮速饱和值U_Rmax；同时，设定减速控制距离常数d₁，并获取当前控制周期的左轮实际轮速v_L(k)和右轮实际轮速v_R(k)；

c2)计算当前控制周期的期望轮速适应差e_u(k)＝u_Rc(k)-u_Lc(k)和实际轮速差e_v(k)＝v_R(k)-v_L(k)；进而求得当前控制周期的控制向差E(k)＝e_u(k)-e_v(k)；

c3)按如下公式确定特征模态集Φ：

c4)按如下公式确定控制模态集Ψ：

并且，在控制模态ψ₅和ψ₆中，左轮期望轮速u_L(k)还同时满足：

在控制模态ψ₁₁和ψ₁₂中，右轮期望轮速u_R(k)还同时满足：

c5)特征模态集Φ与控制模态集Ψ的关联关系为：

若φ_j成立，则ψ_j；j∈{1，2，...，13}；

即特征模态φ_j与控制模态ψ_j按下标号一对一对应关联；根据该关联关系获得当前控制周期的左轮期望轮速u_L(k)和右轮期望轮速u_R(k)；

d)增量式控制器在各个控制周期重复步骤a)～c)，并输出期望轮速向量U，直至机器人到达目标点；其中，

U=uRuL;]]>

u_L和u_R分别为增量式控制器输出的左轮期望轮速和右轮期望轮速。

2.根据权利要求1所述的两轮轮式机器人点镇定增量式智能控制方法，其特征在于，所述步骤b)中，任务适应级采用的广义的比例控制为经典比例控制。

3.根据权利要求1所述的两轮轮式机器人点镇定增量式智能控制方法，其特征在于，所述步骤b)中，任务适应级采用的广义的比例控制为比例余弦控制。