公开(公告)号：CN116141341A

公开(公告)日：2023-05-23

申请号：CN202310432715.3

申请日：2023-04-21

Applicant: 之江实验室

Inventor： 黄秋兰 ,  郑博升 ,  宛敏红 ,  宋伟 ,  谢安桓 ,  朱世强 ,  顾建军

IPC: B25J9/16

Abstract: 本发明公开了一种满足笛卡尔空间约束的五自由度机械臂指向动作实现方法，包括：获取机械臂的各个关节杆长、待指向目标点、待指向目标点轨迹序列；以腕部坐标系向外坐标轴与待指向目标点共线为主要优化目标，构建非线性优化方程组；以待指向目标点轨迹序列作为输入，使用序列最小二乘法对非线性优化方程组进行优化求解；若优化求解得到的关节变量和上一帧的关节变量的变化量超出可允许范围，则选用上一帧的关节变量赋到关节变量序列中；反之则对将优化求解得到的关节变量加入关节变量序列中，并对关节变量序列进行角度插补；将进行角度插补后的关节角度序列数据传输到机器人工控机上，以使用伺服控制的方法驱动5R机械臂指向目标点轨迹。

公开(公告)号：CN116141341B

公开(公告)日：2023-08-08

申请号：CN202310432715.3

申请日：2023-04-21

Applicant: 之江实验室

Inventor： 黄秋兰 ,  郑博升 ,  宛敏红 ,  宋伟 ,  谢安桓 ,  朱世强 ,  顾建军

IPC: B25J9/16

Abstract: 本发明公开了一种满足笛卡尔空间约束的五自由度机械臂指向动作实现方法，包括：获取机械臂的各个关节杆长、待指向目标点、待指向目标点轨迹序列；以腕部坐标系向外坐标轴与待指向目标点共线为主要优化目标，构建非线性优化方程组；以待指向目标点轨迹序列作为输入，使用序列最小二乘法对非线性优化方程组进行优化求解；若优化求解得到的关节变量和上一帧的关节变量的变化量超出可允许范围，则选用上一帧的关节变量赋到关节变量序列中；反之则对将优化求解得到的关节变量加入关节变量序列中，并对关节变量序列进行角度插补；将进行角度插补后的关节角度序列数据传输到机器人工控机上，以使用伺服控制的方法驱动5R机械臂指向目标点轨迹。