【技术实现步骤摘要】
基于梯度下降和指数衰减的轮式移动机械臂姿态调整方法
[0001]本专利技术涉及轮式移动机械臂的规划控制领域,尤其是涉及一种梯度下降和指数衰减的轮式移动机械臂姿态调整方法。
技术介绍
[0002]轮式移动机械臂是一种灵活、高效、可操作的机器人,已广泛应用于物流、服务、海洋、太空等领域。在轮式移动机械臂执行不同的操作任务时,往往需要进行不同姿态之间的调整;即从当前的姿态调整到某个指定或期望的姿态(作为执行操作任务时的起始姿态)。针对轮式移动机械臂的姿态调整,一般是先调整移动平台的姿态,再调整机械臂的关节状态。显然,这样的调整方法存在复杂、耗时、精度低等缺陷。因为要多次测量移动平台的位置和朝向角以及机械臂各个关节的角度,才能保证轮式移动机械臂是准确地到达所指定或期望的姿态来执行相关的操作任务。
[0003]例如中国专利CN202111142636.6公开了一种基于梯度下降的轮式移动机器人状态调整方法,目前现有技术都是在速度层上进行研究和设计的,这些方案在轮式移动机械臂在执行不同的操作任务时都需要多次测量移动平台和机械臂姿态,过程繁琐且对于姿态的感知与调整相对滞后。如果姿态调整的结果不准确,轮式移动机械臂极有可能无法完成给的操作任务;甚至还会因为出现未知姿态而导致轮式移动机械臂与工作空间中的物体发生碰撞,造成严重的经济损失。
技术实现思路
[0004]本专利技术的目的是克服上述现有技术存在的缺陷而提供一种基于梯度下降和指数衰减的轮式移动机械臂姿态调整方法。
[0005]本专利技术的目的可以通过 ...
【技术保护点】
【技术特征摘要】
1.一种基于梯度下降和指数衰减的轮式移动机械臂姿态调整方法,所述轮式移动机械臂包括具有多个驱动轮的移动平台和设于移动平台上的机械臂,其特征在于,所述方法步骤包括:获取轮式移动机械臂的状态参数,将状态参数输入预先构建的加速度层姿态调整模型中;求解加速度层姿态调整模型,得到移动平台驱动轮的旋转角度、旋转角速度和旋转角加速度以及机械臂关节的角度、速度和加速度;根据求解结果实时驱动移动平台的驱动轮和机械臂的关节,使轮式移动机械臂从当前的姿态调整到期望的姿态;所述加速度层姿态调整模型,基于采用梯度下降公式和指数衰减公式推导二次型性能指标,结合移动平台的运动学方程以及轮式移动机械臂的物理极限建立。2.根据权利要求1所述的一种基于梯度下降和指数衰减的轮式移动机械臂姿态调整方法,其特征在于,所述采用梯度下降公式和指数衰减公式推导的二次型性能指标表示为:其中,||
·
||2表示向量的二范数,和表示轮式移动机械臂的联合加速度向量和联合速度向量,和分别表示机械臂关节的加速度和速度,和分别表示移动平台驱动轮旋转角的加速度和速度,n表示安装在移动平台上的机械臂自由度的个数,2表示移动平台驱动轮的个数;D∈R
(3+n)
×
(2+n)
和M∈R
3+n
为系数矩阵,表示D的时间导数;e为增广矩阵,表示轮式移动机械臂当前姿态与期望姿态之间的误差。3.根据权利要求2所述的一种基于梯度下降和指数衰减的轮式移动机械臂姿态调整方法,其特征在于,所述系数矩阵D表达式如下:D=[A,0;0,I
n
]∈R
(3+n)
×
(2+n)
其中,A∈R3×2表示由移动平台结构参数组成的矩阵,I
n
∈R
n
×
n
表示单位矩阵;系数矩阵M表达式如下:M=[(λ1+k1)I2,0,0;0,λ2((cos2φ)+sinφsinφ
d
)+k2;0,0,(λ3+k3)I
n
]∈R
3+n
其中,λ
i
和k
i
(i=1,2,3)表示实现状态姿态的设计参数,φ∈R表示移动平台的朝向角;增广矩阵e表达式如下:其中,p
xy
表示移动平台在水平地面上的沿着XY轴方向的坐标,φ
d
和θ
d
分别表示移动平台在水平地面上沿着XY轴方向上的期望坐标和期望朝向角以及机械臂关节的期望角度。4.根据权利要求3所述的一种基于梯度下降和指数衰减的轮式移动机械臂姿态调整方法,其特征在于,所述由移动平台结构参数组成的...
【专利技术属性】
技术研发人员:仓乃梦,陈树康,郭东生,张卫东,吴迪,贾泽华,曹刚,陆海博,张俊峰,毋媛媛,张永辉,唐浩,刘炳言,张安民,
申请(专利权)人:海南大学,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。