CN207027520U - 一种机械臂移动路径规划系统 - Google Patents

Abstract

本实用新型提供了一种机械臂移动路径规划系统，包括双目视觉系统、图像处理模块、坐标提取模块、模型构建模块和路径规划模块，所述的双目视觉系统对周边环境进行图像采集并将图像传输至图像处理模块进行处理，通过坐标提取模块对障碍物坐标值进行提取，所述的模型构建模块调用坐标数据并构建机械臂运动模型，所述的模型构建模块下行与路径规划模块连接，本实用新型结构简单，使用方便，结合遗传算法和蚁群算法的优点，对关节和末端器分别进行控制，既可以发挥遗传算法整体规划的特点，又可以发挥蚁群算法局部最优的特点，保证路径规划准确性的同时节约了计算量。

Description

一种机械臂移动路径规划系统

技术领域

本实用新型涉及路径规划技术领域，尤其涉及一种机械臂移动路径规划系统及。

背景技术

目前机械臂移动规划路径算法主要包括遗传算法和蚁群算法，其中遗传算法具有整体优化特点，适合各个关节处的路径规划，但是计算量较大；蚁群算法对局部路径规划具有最优性，但是对整体规划具有局限性。

实用新型内容

本实用新型提供了一种机械臂移动路径规划系统，结构简单，使用方便，结合遗传算法和蚁群算法的优点，对关节和末端器分别进行控制，既可以发挥遗传算法整体规划的特点，又可以发挥蚁群算法局部最优的特点，保证路径规划准确性的同时节约了计算量。

为解决上述技术问题，本申请实施例提供了一种机械臂移动路径规划系统，包括双目视觉系统、图像处理模块、坐标提取模块、模型构建模块和路径规划模块，所述的双目视觉系统对周边环境进行图像采集并将图像传输至图像处理模块进行处理，通过坐标提取模块对障碍物坐标值进行提取，所述的模型构建模块调用坐标数据并构建机械臂运动模型，所述的模型构建模块下行与路径规划模块连接。

作为本方案的优选实施例，所述的双目视觉系统包括左摄像头和右摄像头两组，所述的左右摄像头下行与矫正模块连接，所述的矫正模块下行设有双目匹配模块，所述的双目匹配模块与距离计算模块连接。

作为本方案的优选实施例，所述的图像处理模块与图像切割模块连接，所述的图像切割模块将图像按图层分为多区域，所述的图像处理模块对各区域的处理为并行关系。

作为本方案的优选实施例，所述的坐标提取模块与存储模块连接，所述的模型构建模块与存储模块连接并调用其内部相关数据。

作为本方案的优选实施例，所述的模型构建模块内置广义雅可比矩阵程序。

作为本方案的优选实施例，所述的路径规划模块包括遗传算法模块和蚁群算 法模块，所述的遗传算法模块对机械臂关节进行路径规划，所述的蚁群算法模块与机械臂末端器进行路径规划。

作为本方案的优选实施例，所述的路径规划模块下行设有检测机械臂和障碍物之间距离的距离检测模块，所述的距离检测模块内置碰撞检测公式程序。

作为本方案的优选实施例，所述的距离检测模块下行设有实时反馈模块，所述的实时反馈模块与模型构建模块连接。

本申请实施例中提供的一个或多个技术方案，至少具有如下技术效果或优点：

结构简单，使用方便，结合遗传算法和蚁群算法的优点，对关节和末端器分别进行控制，既可以发挥遗传算法整体规划的特点，又可以发挥蚁群算法局部最优的特点，保证路径规划准确性的同时节约了计算量。

附图说明

为了更清楚地说明本实用新型实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅是本实用新型的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。

图1是本申请实施例的结构示意图；

图1中，1、双目视觉系统，2、图像处理模块，3、坐标提取模块，4、模型构建模块，5、路径规划模块，6、左摄像头，7、右摄像头，8、矫正模块，9、双目匹配模块，10、距离计算模块，11、图像切割模块，12、存储模块，13、遗传算法模块，14、蚁群算法模块，15、距离检测模块，16、实时反馈模块。

具体实施方式

本实用新型提供了一种机械臂移动路径规划系统，结构简单，使用方便，结合遗传算法和蚁群算法的优点，对关节和末端器分别进行控制，既可以发挥遗传算法整体规划的特点，又可以发挥蚁群算法局部最优的特点，保证路径规划准确性的同时节约了计算量。

为了更好的理解上述技术方案，下面将结合说明书附图以及具体的实施方式对上述技术方案进行详细的说明。

如图1所示，一种机械臂移动路径规划系统，包括双目视觉系统1、图像处 理模块2、坐标提取模块3、模型构建模块4和路径规划模块5，所述的双目视觉系统1对周边环境进行图像采集并将图像传输至图像处理模块2进行处理，通过坐标提取模块3对障碍物坐标值进行提取，所述的模型构建模块4调用坐标数据并构建机械臂运动模型，所述的模型构建模块4下行与路径规划模块5连接。

其中，在实际应用中，所述的双目视觉系统1包括左摄像头6和右摄像头7两组，所述的左右摄像头下行与矫正模块8连接，所述的矫正模块8下行设有双目匹配模块9，所述的双目匹配模块9与距离计算模块10连接，所述的左右摄像头采集参数，矫正模块去除光学畸变的影响，双目匹配模块计算相机匹配点并得到视差图，距离计算模块根据参数计算得到实际深度。

其中，在实际应用中，所述的图像处理模块2与图像切割模块11连接，所述的图像切割模块11将图像按图层分为多区域，所述的图像处理模块2对各区域的处理为并行关系，可有效提高图像处理的效率。

其中，在实际应用中，所述的坐标提取模块3与存储模块12连接，所述的模型构建模块4与存储模块12连接并调用其内部相关数据，方便后续参数的调用，可重复利用。

其中，在实际应用中，所述的模型构建模块4内置广义雅可比矩阵程序，提高模型构建的准确性和快速性。

其中，在实际应用中，所述的路径规划模块5包括遗传算法模块13和蚁群算法模块14，所述的遗传算法模块13对机械臂关节进行路径规划，所述的蚁群算法模块14与机械臂末端器进行路径规划，充分利用二者优势，保证准确性同时提高效率。

其中，在实际应用中，所述的路径规划模块5下行设有检测机械臂和障碍物之间距离的距离检测模块15，所述的距离检测模块内置碰撞检测公式程序，防止机械臂与障碍物发生碰撞。

其中，在实际应用中，所述的距离检测模块15下行设有实时反馈模块16，所述的实时反馈模块16与模型构建模块4连接，可根据实际情况实时调控机械臂运动，及时调整误差，保证准确性。

以上所述，仅是本实用新型的较佳实施例而已，并非对本实用新型作任何形式上的限制，虽然本实用新型已以较佳实施例揭露如上，然而并非用以限定本实 用新型，任何熟悉本专业的技术人员，在不脱离本实用新型技术方案范围内，当可利用上述揭示的技术内容作出些许更动或修饰为等同变化的等效实施例，但凡是未脱离本实用新型技术方案的内容，依据本实用新型的技术实质对以上实施例所作的任何简单修改、等同变化与修饰，均仍属于本实用新型技术方案的范围内。

Claims (8)

1.一种机械臂移动路径规划系统，包括双目视觉系统(1)、图像处理模块(2)、坐标提取模块(3)、模型构建模块(4)和路径规划模块(5)，其特征在于，所述的双目视觉系统(1)对周边环境进行图像采集并将图像传输至图像处理模块(2)进行处理，通过坐标提取模块(3)对障碍物坐标值进行提取，所述的模型构建模块(4)调用坐标数据并构建机械臂运动模型，所述的模型构建模块(4)下行与路径规划模块(5)连接。

2.根据权利要求1所述的一种机械臂移动路径规划系统，其特征在于，所述的双目视觉系统(1)包括左摄像头(6)和右摄像头(7)两组，所述的左右摄像头下行与矫正模块(8)连接，所述的矫正模块(8)下行设有双目匹配模块(9)，所述的双目匹配模块(9)与距离计算模块(10)连接。

3.根据权利要求1所述的一种机械臂移动路径规划系统，其特征在于，所述的图像处理模块(2)与图像切割模块(11)连接，所述的图像切割模块(11)将图像按图层分为多区域，所述的图像处理模块(2)对各区域的处理为并行关系。

4.根据权利要求1所述的一种机械臂移动路径规划系统，其特征在于，所述的坐标提取模块(3)与存储模块(12)连接，所述的模型构建模块(4)与存储模块(12)连接并调用其内部相关数据。

5.根据权利要求1所述的一种机械臂移动路径规划系统，其特征在于，所述的模型构建模块(4)内置广义雅可比矩阵程序。

6.根据权利要求1所述的一种机械臂移动路径规划系统，其特征在于，所述的路径规划模块(5)包括遗传算法模块(13)和蚁群算法模块(14)，所述的遗传算法模块(13)对机械臂关节进行路径规划，所述的蚁群算法模块(14)与机械臂末端器进行路径规划。

7.根据权利要求1所述的一种机械臂移动路径规划系统，其特征在于，所述的路径规划模块(5)下行设有检测机械臂和障碍物之间距离的距离检测模块(15)，所述的距离检测模块内置碰撞检测公式程序。

8.根据权利要求7所述的一种机械臂移动路径规划系统，其特征在于，所述的距离检测模块(15)下行设有实时反馈模块(16)，所述的实时反馈模块(16)与模型构建模块(4)连接。