一种机械臂移动路径规划系统及方法技术方案

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

Mechanical arm moving path planning system and method

The invention provides a mobile manipulator path planning system and method, including the binocular vision system, image processing module, coordinate extraction module, model and path planning module, binocular vision system and the image acquisition of the surrounding environment and the image transmission and image processing module for processing module to extract the obstacle coordinates by coordinate extraction, the model called coordinate data and construct the manipulator motion model construction module connected with the downlink path planning module of the model, the invention has the advantages of simple structure, convenient use, combined with the advantages of genetic algorithm and ant colony algorithm, the joint and the end effector are controlled separately, both you can play the characteristics of genetic algorithm of overall planning, can play the characteristics of ant colony algorithm local optimal path planning, ensure accurate At the same time, the amount of calculation is saved.

【技术实现步骤摘要】
一种机械臂移动路径规划系统及方法
本专利技术涉及路径规划
，尤其涉及一种机械臂移动路径规划系统及方法。
技术介绍
目前机械臂移动规划路径算法主要包括遗传算法和蚁群算法，其中遗传算法具有整体优化特点，适合各个关节处的路径规划，但是计算量较大；蚁群算法对局部路径规划具有最优性，但是对整体规划具有局限性。
技术实现思路
本专利技术提供了一种机械臂移动路径规划系统及方法，结构简单，使用方便，结合遗传算法和蚁群算法的优点，对关节和末端器分别进行控制，既可以发挥遗传算法整体规划的特点，又可以发挥蚁群算法局部最优的特点，保证路径规划准确性的同时节约了计算量。为解决上述技术问题，本申请实施例提供了一种机械臂移动路径规划系统及方法，包括双目视觉系统、图像处理模块、坐标提取模块、模型构建模块和路径规划模块，所述的双目视觉系统对周边环境进行图像采集并将图像传输至图像处理模块进行处理，通过坐标提取模块对障碍物坐标值进行提取，所述的模型构建模块调用坐标数据并构建机械臂运动模型，所述的模型构建模块下行与路径规划模块连接。作为本方案的优选实施例，所述的双目视觉系统包括左摄像头和右摄像头两组，所述的左右摄像头下行与矫正模块连接，所述的矫正模块下行设有双目匹配模块，所述的双目匹配模块与距离计算模块连接。作为本方案的优选实施例，所述的图像处理模块与图像切割模块连接，所述的图像切割模块将图像按图层分为多区域，所述的图像处理模块对各区域的处理为并行关系。作为本方案的优选实施例，所述的坐标提取模块与存储模块连接，所述的模型构建模块与存储模块连接并调用其内部相关数据。作为本方案的优选实施例，所述的模型构建模块内置广义雅可比矩阵程序。作为本方案的优选实施例，所述的路径规划模块包括遗传算法模块和蚁群算法模块，所述的遗传算法模块对机械臂关节进行路径规划，所述的蚁群算法模块与机械臂末端器进行路径规划。作为本方案的优选实施例，所述的路径规划模块下行设有检测机械臂和障碍物之间距离的距离检测模块，所述的距离检测模块内置碰撞检测公式程序。作为本方案的优选实施例，所述的距离感应器下行设有实时反馈模块，所述的实时反馈模块与模型构建模块连接。一种机械臂移动路径规划方法，其实现的具体方法为：。步骤1：首先采用双目视觉系统，对周围环境进行图像采集，并利用处理模块及坐标提取模块对图像进行处理得到环境障碍物等物体的坐标；步骤2：采用模型构建模块对机械臂进行运动模型构建；步骤3：利用蚁群算法模块对机械臂末端器进行路径规划，利用遗传算法模块对整个机械臂的各个关节运动进行路径规划；步骤4：:利用距离检测模块对机械臂与障碍物之间的距离进行检测，实时反馈模块对检测结果进行实时反馈，并连接模型构建模块进行实时调整。本申请实施例中提供的一个或多个技术方案，至少具有如下技术效果或优点：结构简单，使用方便，结合遗传算法和蚁群算法的优点，对关节和末端器分别进行控制，既可以发挥遗传算法整体规划的特点，又可以发挥蚁群算法局部最优的特点，保证路径规划准确性的同时节约了计算量。附图说明为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。图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连接，可根据实际情况实时调控机械臂运动，及时调整误差，保证准确性。本实施例所述的一种机械臂移动路径规划方法，其实现的具体方法为：。步骤1：首先采用双目视觉系统1，对周围环境进行图像采集，并利用处理模块2及坐标提取模块3对图像进行处理得到环境障碍物等物体的坐标；步骤2：采用模型构建模块4对机械臂进行运动模型构建；步骤3：利用蚁群算法模块14对机械臂末端器进行路径规划，利用遗传算法模块13对整个机械臂的各个关节运动进行路径规划；步骤4：:利用距离检测模块15对机械臂与障碍物之间的距离进行检测，实时反馈模块16对检测结果进行实时反馈，并连接模型构建模块4进行实时调整。以上所述，仅是本专利技术的较佳实施例而已，并非对本专利技术作任何形式上的限制，虽然本专利技术已以较佳实施例揭露如上，然而并非用以限定本专利技术，任何熟悉本专业的技术人员，在不脱离本专利技术技术方案范围内，当可利用上述揭示的
技术实现思路
作出些许更动或修饰为等同变化的等效实施例，但凡是未脱离本专利技术技术方案的内容，依据本专利技术的技术实质对以上实施例所作的任何简单修改、等同变化与修饰，均仍属于本专利技术技术方案的范围内。本文档来自技高网...

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

【技术特征摘要】
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)内...

【专利技术属性】
技术研发人员：贾桂红，曹锋，
申请(专利权)人：华北电力大学保定，
类型：发明
国别省市：河北,13