公开(公告)号：CN116945192A

公开(公告)日：2023-10-27

申请号：CN202311170380.9

申请日：2023-09-11

Applicant: 海南大学

Inventor： 陈树康 ,  郭东生 ,  仓乃梦 ,  张卫东 ,  史开松 ,  李奇朔 ,  吴迪 ,  贾泽华 ,  曹刚 ,  薛珊 ,  郑金荣 ,  王谋业 ,  杨胜辉

IPC: B25J9/16

Abstract: 本发明涉及一种三轮全向移动机械臂自运动规划方法，方法包括：S1、采用梯度下降公式，推导机械臂从不同初始状态调整到期望状态的速度层指标；S2、引入末端定位误差及其积分的反馈，并结合移动平台的运动学方程和S1的速度层指标，设计以伪逆形式描述的自运动规划方案；S3、获取机械臂的初始状态，将初始状态代入自运动规划方案进行迭代计算，得到自运动规划的驱动轮旋转角速度和关节速度；S4、将自运动规划的驱动轮旋转角速度和关节速度发送至三轮全向移动机械臂的下位机控制器，驱动三轮全向移动机械臂和移动平台达到期望状态。与现有技术相比，本发明具有完成不同状态之间的自动、快速、准确调整等优点。