[发明专利]一种机械臂的自动避障方法及装置

权利要求书

1.一种机械臂的自动避障方法，其特征在于，包括：

获取机械臂作业环境的三维信息，生成第一环境三维点云数据；

对所述第一环境三维点云数据进行去噪处理，得到第二环境三维点云数据；

基于所述第二环境三维点云数据，构建环境避障地图；

确定所述机械臂在所述环境避障地图中的当前位置和目标位置；

根据所述目标位置以及机械臂目标点位姿，确定避障路径，以使所述机械臂从当前位置沿避障路径移动到目标位置。

2.根据权利要求1所述的机械臂的自动避障方法，其特征在于，所述对所述第一环境三维点云数据进行去噪处理，得到第二环境三维点云数据，包括：

利用条件滤波、体素滤波以及半径滤波对所述第一环境三维点云数据进行去噪处理，得到第二环境三维点云数据。

3.根据权利要求1所述的机械臂的自动避障方法，其特征在于，所述基于所述第二环境三维点云数据，构建环境避障地图，包括：

基于所述第二环境三维点云数据，设定最大递归深度；

将任一选定点云点的指定分辨率半径内的所有点云点全部视为一个父立方体，并将所述父立方体块细分八等份，得到八个子立方体；

将所述父立方体内的所有点云点全部分担给所述八个子立方体；

若发现所述子立方体所分配到的点云点数量不为零且跟所述父立方体是一样的，则所述子立方体停止细分，并判定此时是否达到最大递归深度；

若达到最大递归深度，则基于所述子立方体，构建环境避障地图。

4.根据权利要求1所述的机械臂的自动避障方法，其特征在于，所述确定所述机械臂在所述环境避障地图中的当前位置和目标位置，包括：

构建点云地图原点与机械臂世界地图原点之间的坐标变换关系；

利用机器人操作系统对所述机械臂进行机械臂建模，并将环境模型与机械臂模型置于同一个坐标系下；

将机械臂在机械臂世界地图坐标系下的当前位置坐标和目标位置坐标通过所述变换关系转移到环境避障地图坐标系下。

5.根据权利要求1所述的机械臂的自动避障方法，其特征在于，所述根据所述目标位置以及机械臂目标点位姿，确定避障路径，包括：

确定所述机械臂目标点位姿，并对机械臂末端目标位置求逆解；

利用避障路径算法，确定避障路径，以使所述机械臂完成避障路径的运动。

6.根据权利要求5所述的机械臂的自动避障方法，其特征在于，所述确定所述机械臂目标点位姿，包括：

根据所述机械臂的作业环境确定所述机械臂目标点位姿。

7.根据权利要求5所属的机械臂的自动避障方法，其特征在于，所述对机械臂末端目标位置求逆解，包括：

基于机械臂三维模型，编写机械臂逆运动学求解算法；

根据所述机械臂逆运动学求解算法对机械臂末端目标位置求逆解。

8.根据权利要求5所述的机械臂的自动避障方法，其特征在于，所述利用避障路径算法，确定避障路径，包括：

在所述目标位置和所述当前位置同时生长两棵快速扩展路径树来搜索状态空间；

在每一次迭代中，根据采样路径点进行扩展；

当扩展结果显示两路径树产生交汇后，停止扩展，并确定两路径树交汇点的结果为避障路径。

9.根据权利要求1-8所述的机械臂的自动避障方法，其特征在于，利用机器人操作系统完成机械臂与上位机之间的通讯以及避障路径的规划，并控制机械臂完成避障路径的运动。

10.一种机械臂的自动避障系统，其特征在于，包括：

信息获取模块，用于获取机械臂作业环境的三维信息，生成第一环境三维点云数据；

去噪处理模块，用于对所述第一环境三维点云数据进行去噪处理，得到第二环境三维点云数据；

地图构建模块，用于基于所述第二环境三维点云数据，构建环境避障地图；

位置确定模块，用于确定所述机械臂在所述环境避障地图中的当前位置和目标位置；

路径确定模块，用于根据所述目标位置以及机械臂目标点位姿，确定避障路径，以使所述机械臂从当前位置沿避障路径移动到目标位置。