[发明专利]一种超冗余机械臂分段式动态避障方法

说明书

本发明公开了一种超冗余机械臂分段式动态避障方法。首先，针对场景中的机械臂状态信息与观测到的障碍物信息，建立以机械臂为中心的动态障碍预警区域。其次，当障碍物进入该区域监测范围内，基于速度障碍策略构建碰撞风险评估模型，实时评估机械臂与障碍物间的碰撞可能性。再次，若存在碰撞风险，依据障碍物信息将机械臂划分为若干避障区域，构建局部避障速度约束、关节限位约束以及连杆长度约束，求解机械臂各关节安全速度集合。最后，通过前后向迭代逆运动学求解算法实时更新机械臂位姿，进而实现动态障碍场景下的超冗余机械臂分段式避障。本发明充分发挥超冗余机械臂的灵活特性，使其在动态障碍场景下具有更好的适应能力。

技术领域

本发明涉及机械臂技术领域，具体为一种超冗余机械臂分段式动态避障方法。

背景技术

面向受限空间、危险环境和复杂任务下的机器人作业，传统工业机械臂由于尺寸、驱动配置和自由度的限制而难以满足复杂工况下的应用需求。而超冗余机械臂依托仿生蛇类机理，通过融合蛇类脊椎骨结构与运动特性，具备长径比大、冗余度高、柔顺性强、可达域广等特点和优越的连续弯曲与避障能力，在航空航天、核电等大型精密化设备深腔检测作业中可发挥不可替代的作用。

超冗余机械臂的灵活控制需要更完整、更高效的运动与避障策略，然而，冗余的自由度导致机械臂的控制难度成倍增长，且传统机械臂的避障算法存在规划决策效率低、对环境动态响应慢等缺陷，难以直接应用于超冗余机械臂。此外，机械臂各关节之间的配合关系具有强耦合性，单个连杆的变化会致使其余多个连杆的姿态调整，极大制约了超冗余蛇形机械臂的避障能力。

近年来，一系列超冗余机械臂的避障方法已被提出，主要分为以下几种：①基于人工势场法的方法，通过引入目标引力场与障碍物产生的斥力场，驱动机械臂避开障碍，但计算时易陷入局部力平衡状态，尤其当多个障碍同时作用时算法会失效；②基于C空间规划的方法，先根据机械臂的状态特征建立机械臂所有可行C空间，再将障碍物映射到C空间内，进一步规划出C空间的无碰轨迹，但随着机械臂冗余度的增加，该方法求解效率低，难以实现实时避障需求；③基于末端跟随的方法，根据既定场景规划出一条无碰轨迹，并通过末端主动、余下关节节点从动的方式避开障碍，但该方法多应用于已知静态障碍物，缺乏对动态障碍物的适应能力。上述避障策略并不能在保证求解效率的情况下有效解决超冗余机械臂的动态避障问题。

基于此，本发明提供了一种超冗余机械臂分段式动态避障方法。

发明内容

以下给出一个或多个方面的主要概述以应对这些方面的基本理解。此概述不能将所有的构想进行详述，其唯一的目的是要以简化形式给出一个或多个方面的一些概念以为稍后给出的更加详细的描述之序。

本发明提供一种超冗余机械臂分段式动态避障方法，包含以下步骤：

步骤1：针对场景中的机械臂状态信息与观测到的障碍物信息，建立以机械臂为中心的动态障碍预警区域。

步骤1.1：从三维捕捉系统与机械臂关节内部陀螺仪获取机械臂的状态信息：几何构型、机械臂臂型姿态、第i节机械臂连杆速度v_Li，与障碍物信息：几何构型、障碍物当前速度v_o，其中，i＝1，2，…，n，n表示超冗余机械臂连杆数量。

步骤1.2：利用封闭式椭球体将机械臂各连杆进行包覆，记包覆第i节机械臂连杆的封闭式椭球体为根据障碍物几何构型利用封闭式凸几何体对障碍物进行包覆，记包覆障碍物的封闭式凸几何体为

步骤1.3：将连杆进行简化，以障碍物质心为中心构建各连杆与障碍物间的封闭式闵可夫斯基和，记为：

式中，用表示闵可夫斯基和运算，表示取区域内任意一点x，表示取区域内任意一点y。