欢迎来到知嘟嘟! 联系电话:13095918853 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13095918853
知嘟嘟经纪人
收藏
专利号: 2019109275977
申请人: 华侨大学
专利类型:发明专利
专利状态:已下证
专利领域: 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手
更新日期:2024-01-05
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种冗余度机械臂加速度层多目标规划方法,其特征在于,包括如下步骤:

1)设计加速度层的优化性能指标和避障不等式,所述加速度层的优化性能指标为:其中||·||2表示向量的二范数,表示机械臂关节加速度,表示机械臂关节速度,θ表示机械臂关节角度,θ(0)表示机械臂关节的初始状态;设计参数λ>0用于调节性能指标以使机械臂达到重复运动规划的目的;所述避障不等式为:T

其中,系数矩阵M和N分别定义为M=‑[xC‑xO ,yC‑yO ,zC‑zO] JC和T

上标表示矩阵或向量的转置,(xC,yC,zC)表示机械臂判据点的空间坐标,(xO,yO,zO)表示环境障碍物点的空间坐标,JC表示机械臂判据点的雅克比矩阵, 表示JC的时间导数;

2)结合机械臂末端的规划任务、机械臂关节的物理极限及加速度层的优化性能指标建立加速度层多目标规划方案,其受约束于加速度层雅可比矩阵等式、机械臂动力学方程、避障不等式、关节角度极限、关节速度极限、关节加速度极限和关节力矩极限;所述加速度层多目标规划方案设计为:最小化

‑ +

受约 束于 θ ≤θ≤θ ,

‑ +

τ≤τ≤τ;

其中等式约束 对应于机械臂末端在加速度层的运动规划任务,α和β表示设计参数且其数值满足α>0和β>0,J表示机械臂的雅可比矩阵,表示J的时间导数,e表示机械臂末端的位置误差且定义为e=f(θ)‑rd,f(·)表示一个非线性映射函数,rd表示机械臂末端运动的期望轨迹,ε表示机械臂末端的速度误差且定义为 表示rd的时间导数, 表示 的时间导数;等式约束 表示机械臂的动力学方程,H表示机械臂惯性矩阵,c表示离心力变量,g表示重力变量,τ表示机械臂关节力矩;不等式约± ±束 用于实现机械臂对环境障碍物的躲避;θ、 和τ分别表示关节角度极限、关节速度极限、关节加速度极限和关节力矩极限;

3)将加速度层多目标规划方案转化为一个标准的二次型优化问题,并采用数值算法来对其进行求解;

4)下位机控制器根据求解结果,驱动机械臂各个关节动作完成给定的末端规划任务。

2.如权利要求1所述的一种冗余度机械臂加速度层多目标规划方法,其特征在于,将加速度T T层多目标规划方案转化为一个标准的二次型优化问题,其性能指标为xx/2+px,约束条件为Cx‑ +=d,Ax≤b,η≤x≤η,其中, C=J, AT T T T ±

=[M ‑H H ] , η表示联立关节角度θ、关节速度 和关节加速度 后的上下极限,并且,

k1>0和k2>0表示关节极限转换参数,δ>0表示关节极限转换裕量。

3.如权利要求1或2所述的一种冗余度机械臂加速度层多目标规划方法,其特征在于,采用数值算法来对二次型优化问题进行求解,具体为:将二次型优化问题的求解转化等效为一个分段线性投影方程的求解,从而采用相应的数值算法来计算得到分段线性投影方程的解以及二次型优化问题的最优化解。