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

摘要:

权利要求书:

1.一种机械臂运动规划方法,其特征在于,所述方法包括:获取待抓取物的位置数据、碰撞体积信息和机械臂的末端执行器的位姿数据;

根据所述位姿数据、所述待抓取物的位置数据和生长步数,确定出所述末端执行器的运动轨迹;

在所述运动轨迹的基础上根据所述碰撞体积信息和障碍生长步数进行运动,得到所述末端执行器进行障碍生长的目标轨迹,其中,所述目标轨迹为所述机械臂进行运动规划的目标运动方案。

2.根据权利要求1所述的方法,其特征在于,所述运动轨迹为忽略所述碰撞体积信息的轨迹;所述根据所述位姿数据、所述待抓取物的位置数据和生长步数,确定出所述末端执行器的运动轨迹,包括:

根据所述位姿数据、所述位置数据和生长步数,确定出所述末端执行器的初始轨迹;

判断所述初始轨迹是否满足碰撞约束;

若所述初始轨迹满足所述碰撞约束,则将所述初始轨迹作为所述运动轨迹。

3.根据权利要求2所述的方法,其特征在于,在所述判断所述初始轨迹是否满足碰撞约束之后,所述方法还包括:

若所述初始轨迹不满足所述碰撞约束,则对所述初始轨迹进行调整,得到初始调整轨迹;

增加所述生长步数,得到增加步数,直到所述增加步数达到所述末端执行器的最大生长步数;

获取所述末端执行器在所述初始调整轨迹上按照所述增加步数进行运动的轨迹,以对所述初始调整轨迹进行更新,得到第一更新轨迹;

对所述第一更新轨迹重复进行判断、调整和更新步骤,直到所述第一更新轨迹满足所述碰撞约束,以满足所述碰撞约束的当前的第一更新轨迹为所述运动轨迹。

4.根据权利要求3所述的方法,其特征在于,所述对所述初始轨迹进行调整,得到初始调整轨迹,包括:

对所述初始轨迹中的多个点进行碰撞检测,得到所述初始轨迹中不满足所述碰撞检测的第一待调整点;

对所述第一待调整点进行局部调整,得到满足所述碰撞约束且满足与相邻点的关联性要求的第一调整点;

根据所述第一调整点生成所述初始调整轨迹。

5.根据权利要求1所述的方法,其特征在于,所述在所述运动轨迹的基础上根据所述碰撞体积信息和障碍生长步数进行运动,得到所述末端执行器进行障碍生长的目标轨迹,包括:

在所述运动轨迹的基础上,根据所述碰撞体积信息和障碍生长步数,确定出所述末端执行器的初始障碍轨迹;

判断所述初始障碍轨迹是否满足碰撞约束;

若所述初始障碍轨迹满足所述碰撞约束,则将所述初始障碍轨迹作为所述目标轨迹。

6.根据权利要求5所述的方法,其特征在于,在所述判断所述初始障碍轨迹是否满足碰撞约束之后,所述方法还包括:若所述初始障碍轨迹不满足所述碰撞约束,则对所述初始障碍轨迹进行调整,得到初始障碍调整轨迹;

增加所述障碍生长步数,得到障碍增加步数,直到所述障碍增加步数达到所述末端执行器的最大障碍生长步数;

获取所述末端执行器在所述初始障碍调整轨迹上按照所述障碍增加步数进行生长的轨迹,以对所述初始障碍调整轨迹进行更新,得到第二更新轨迹;

对所述第二更新轨迹重复进行判断、调整和更新步骤,直到所述第二更新轨迹满足所述碰撞约束,以满足所述碰撞约束的当前的第二更新轨迹为所述目标轨迹。

7.根据权利要求6所述的方法,其特征在于,所述对所述初始障碍轨迹进行调整,得到初始障碍调整轨迹,包括:

对所述初始障碍轨迹中的多个点进行碰撞检测,得到所述初始障碍轨迹中不满足所述碰撞检测的第二待调整点;

对所述第二待调整点进行局部调整,得到满足所述碰撞约束且满足与相邻点的关联性要求的第二调整点;

根据所述第二调整点生成所述初始障碍调整轨迹。

8.根据权利要求1所述的方法,其特征在于,所述碰撞体积信息包括第一碰撞体积信息和第二碰撞体积信息;所述获取待抓取物的位置数据、碰撞体积信息和机械臂的末端执行器的位姿数据,包括:

计算所述待抓取物的位置数据和障碍物的体积信息;

根据所述位置数据和所述末端执行器计算出所述第一碰撞体积信息;

根据所述障碍物的体积信息和所述机械臂计算出所述第二碰撞体积信息;

基于所述位置数据,计算所述末端执行器进行抓取时的坐标位置;

根据所述坐标位置进行坐标变换,得到所述位姿数据。

9.一种机械臂运动规划装置,其特征在于,所述装置包括:获取单元,用于获取待抓取物的位置数据、碰撞体积信息和机械臂的末端执行器的位姿数据;

生长单元,用于根据所述位姿数据、所述待抓取物的位置数据和生长步数,确定出所述末端执行器的运动轨迹;

障碍生长单元,用于在所述运动轨迹的基础上根据所述碰撞体积信息和障碍生长步数进行运动,得到所述末端执行器进行障碍生长的目标轨迹,其中,所述目标轨迹为所述机械臂进行运动规划的目标运动方案。

10.一种机械臂,其特征在于,所述机械臂中设有可读取存储介质,所述可读取存储介质中存储有计算机程序指令,所述计算机程序指令被一处理器运行时,执行权利要求1‑8任一项所述方法中的步骤。