一种基于运动基元库的带电作业机械臂自主避障路径规划方法
摘要:
本发明提出一种基于运动基元库的带电作业机械臂自主避障路径搜索方法。建立机械臂完整运动学模型、机械臂简化运动学模型并构建机械臂工作环境;分类设计运动基元库,为各类库设计相应运动基元作为库成员;分类建立机械臂与目标点、障碍物的距离计算函数,设置危险区域阈值和到达目标点精度阈值;创建笛卡尔空间中的启发函数hd(x)和关节空间中的启发函数hc(x)以及启发规则,实现启发搜索;计算机械臂当前位姿与期望位姿及障碍物的笛卡尔空间距离,根据设定的判断条件进行路径规划。本发明能快速、精确构建机械臂作业场景信息,保证避障路径搜索结果具有次优性和完备性,满足动力学约束前提下能快速完成路径规划,保证机械臂运动过程的平稳性。
0/0