一种基于立体视觉的机器人主动避障规划方法技术

本发明专利技术公开了一种基于立体视觉的机器人主动避障规划方法，对机器人A的运动范围进行测算，然后选取三个相机C布置点，使得相机C可以全覆盖机器人的工作空间，然后对相机C进行固定，通过手眼标定单元对相机C和机器人A的位置进行标定，然后确认相机C和机器人A的相对位姿关系，本发明专利技术涉及机器人避障技术领域。该基于立体视觉的机器人主动避障规划方法，通过立体视觉点云重建的方法来有效的规划机器人的运动轨迹，保证机器人能够在合理区域运行，并设计出合理、安全的运行轨迹保证末端工具完成既定任务，提高生产效率和安全性，当有突然的事故发生时，机器人能及时规避调整路径，当无法规避时能及时停车，避障效果更好。

A method of Robot Active Obstacle Avoidance Planning Based on stereo vision

【技术实现步骤摘要】
一种基于立体视觉的机器人主动避障规划方法
本专利技术涉及机器人避障
，具体为一种基于立体视觉的机器人主动避障规划方法。
技术介绍
机器人是自动执行工作的机器装置。它既可以接受人类指挥，又可以运行预先编排的程序，也可以根据以人工智能技术制定的原则纲领行动。它的任务是协助或取代人类工作的工作，例如生产业、建筑业，或是危险的工作，狭义上对机器人的定义还有很多分类法及争议，有些电脑程序甚至也被称为机器人，在当代工业中，机器人指能自动执行任务的人造机器装置，用以取代或协助人类工作，理想中的高仿真机器人是高级整合控制论、机械电子、计算机与人工智能、材料学和仿生学的产物，目前科学界正在向此方向研究开发，随着机器人的发展，当今科学技术日益发达，高科技产品尤其是机器人在工业生产中运用的越来越广泛，它能够代替人类完成许许多多的工作，但如何能让机器人自动化的完成人类交给的任务成为设计机器人的关键，国际上对机器人的概念已经逐渐趋近一致，一般来说，人们都可以接受这种说法，即机器人是靠自身动力和控制能力来实现各种功能的一种机器。现阶段机器人在工业生产中基本都是按照人为预设的程序来进行重复性的工作，但当出现不可预见性的突然事故(比如传感器失效、人为误操作等)机器人是无法有效的完成预定的生产任务的，而且常常会造成了人员和设备损伤；而当遇到多设备多人员协作生产的场合时机器人只能通过降低节拍规划干涉区来保证生产工作的正常进行，有些场合甚至只能使用人工方式。
技术实现思路
(一)解决的技术问题针对现有技术的不足，本专利技术提供了一种基于立体视觉的机器人主动避障规划方法，解决了机器人在工业生产中基本都是按照人为预设的程序来进行重复性的工作，但当出现不可预见性的突然事故(比如传感器失效、人为误操作等)机器人是无法有效的完成预定的生产任务的问题。(二)技术方案为实现以上目的，本专利技术通过以下技术方案予以实现：一种基于立体视觉的机器人主动避障规划方法，包括以下步骤：步骤一、深度相机C的布置：对机器人A的运动范围进行测算，然后选取三个相机C布置点，使得相机C可以全覆盖机器人的工作空间，然后对相机C进行固定；步骤二、点云模型的生成：通过手眼标定单元对相机C和机器人A的位置进行标定，然后通过位姿关系确认单元，确认相机C和机器人A的相对位姿关系，通过深度相机C采集点云数据，并且将深度相机C采集到的点云数据通过点云数据转换单元转换后，通过基坐标系生成单元转换到机器人基坐标系A下，然后经过点云融合生成单元将机器人基坐标系A下的点云数据通过点云融合生成单元融合形成机器人A工作空间内的点云模型；步骤三、点云防重叠处理：将步骤二中通过点云融合生成单元融合形成机器人A工作空间内的点云模型经过OTCOMAP转换单元转换成八叉树的形式，然后通过位姿融合单元对位姿进行融合；步骤四、机器人路线的规划：结合步骤三中的通过位姿融合单元中融合的位姿关系，对机器人的路线进行规划，机器人在此空间内根据不同的目标点进行避障路径规划，当出现新的物体出阻碍在机器人前进的路径上时，通过路线重新规划单元重新规划机器人的最优路径，避开障碍，当障碍物距离机器人过近，使得机器人无法调整新的运行轨迹时，提前控制机器人减速停止，重新启动后规划路线。优选的，所述步骤二中的手眼标定单元的输出端与位姿关系确认单元的输入端连接，并且位姿关系确认单元的输出端与点云数据转换单元的输入端连接。优选的，所述步骤二中的点云数据转换单元的输出端与基坐标系生成单元的输入端连接，并且基坐标系生成单元的输出端与点云融合生成单元的输入端连接。优选的，所述步骤二中的点云融合生成单元的输出端与步骤三中的OTCOMAP转换单元的输入端连接。优选的，所述步骤三中的OTCOMAP转换单元的输出端与位姿融合单元的输入端连接。优选的，所述步骤三中位姿融合单元的输出端与步骤四中的路线重新规划单元的输入端连接。优选的，所述步骤一中的相机在固定时，确保相机C的稳定性，不会产生晃动。优选的，所述步骤一中的相机C监控范围内的遮挡物全部去除。(三)有益效果本专利技术提供了一种基于立体视觉的机器人主动避障规划方法。与现有技术相比，具备以下有益效果：该基于立体视觉的机器人主动避障规划方法，通过对机器人A的运动范围进行测算，然后选取三个相机C布置点，使得相机C可以全覆盖机器人的工作空间，然后对相机C进行固定，相机在固定时，确保相机C的稳定性，不会产生晃动，通过手眼标定单元对相机C和机器人A的位置进行标定，然后通过位姿关系确认单元，确认相机C和机器人A的相对位姿关系，通过深度相机C采集点云数据，并且将深度相机C采集到的点云数据通过点云数据转换单元转换后，通过基坐标系生成单元转换到机器人基坐标系A下，然后经过点云融合生成单元将机器人基坐标系A下的点云数据通过点云融合生成单元融合形成机器人A工作空间内的点云模型，将步骤二中通过点云融合生成单元融合形成机器人A工作空间内的点云模型经过OTCOMAP转换单元转换成八叉树的形式，然后通过位姿融合单元对位姿进行融合，结合步骤三中的通过位姿融合单元中融合的位姿关系，对机器人的路线进行规划，机器人在此空间内根据不同的目标点进行避障路径规划，当出现新的物体出阻碍在机器人前进的路径上时，通过路线重新规划单元重新规划机器人的最优路径，避开障碍，当障碍物距离机器人过近，使得机器人无法调整新的运行轨迹时，提前控制机器人减速停止，重新启动后规划路线，通过立体视觉点云重建的方法来有效的规划机器人的运动轨迹，保证机器人能够在合理区域运行，并设计出合理、安全的运行轨迹保证末端工具完成既定任务，提高生产效率和安全性，当有突然的事故发生时，机器人能及时规避调整路径，当无法规避时能及时停车，避障效果更好。附图说明图1为本专利技术的原理图；图2为本专利技术的系统原理框图。具体实施方式下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。请参阅图1-2，本专利技术实施例提供一种技术方案：一种基于立体视觉的机器人主动避障规划方法，包括以下步骤：步骤一、深度相机C的布置：对机器人A的运动范围进行测算，然后选取三个相机C布置点，使得相机C可以全覆盖机器人的工作空间，然后对相机C进行固定，步骤一中的相机在固定时，确保相机C的稳定性，不会产生晃动，步骤一中的相机C监控范围内的遮挡物全部去除；步骤二、点云模型的生成：通过手眼标定单元对相机C和机器人A的位置进行标定，然后通过位姿关系确认单元，确认相机C和机器人A的相对位姿关系，通过深度相机C采集点云数据，并且将深度相机C采集到的点云数据通过点云数据转换单元转换后，通过基坐标系生成单元转换到机器人基坐标系A下，然后经过点云融合生成单元将机器人基坐标系A下的本文档来自技高网...

【技术保护点】
1.一种基于立体视觉的机器人主动避障规划方法，其特征在于：包括以下步骤：/n步骤一、深度相机C的布置：对机器人A的运动范围进行测算，然后选取三个相机C布置点，使得相机C可以全覆盖机器人的工作空间，然后对相机C进行固定；/n步骤二、点云模型的生成：通过手眼标定单元对相机C和机器人A的位置进行标定，然后通过位姿关系确认单元，确认相机C和机器人A的相对位姿关系，通过深度相机C采集点云数据，并且将深度相机C采集到的点云数据通过点云数据转换单元转换后，通过基坐标系生成单元转换到机器人基坐标系A下，然后经过点云融合生成单元将机器人基坐标系A下的点云数据通过点云融合生成单元融合形成机器人A工作空间内的点云模型；/n步骤三、点云防重叠处理：将步骤二中通过点云融合生成单元融合形成机器人A工作空间内的点云模型经过OTCOMAP转换单元转换成八叉树的形式，然后通过位姿融合单元对位姿进行融合；/n步骤四、机器人路线的规划：结合步骤三中的通过位姿融合单元中融合的位姿关系，对机器人的路线进行规划，机器人在此空间内根据不同的目标点进行避障路径规划，当出现新的物体出阻碍在机器人前进的路径上时，通过路线重新规划单元重新规划机器人的路径，避开障碍，当障碍物距离机器人过近，使得机器人无法调整新的运行轨迹时，提前控制机器人减速停止，重新启动后规划路线。/n...

【技术特征摘要】
1.一种基于立体视觉的机器人主动避障规划方法，其特征在于：包括以下步骤：
步骤一、深度相机C的布置：对机器人A的运动范围进行测算，然后选取三个相机C布置点，使得相机C可以全覆盖机器人的工作空间，然后对相机C进行固定；
步骤二、点云模型的生成：通过手眼标定单元对相机C和机器人A的位置进行标定，然后通过位姿关系确认单元，确认相机C和机器人A的相对位姿关系，通过深度相机C采集点云数据，并且将深度相机C采集到的点云数据通过点云数据转换单元转换后，通过基坐标系生成单元转换到机器人基坐标系A下，然后经过点云融合生成单元将机器人基坐标系A下的点云数据通过点云融合生成单元融合形成机器人A工作空间内的点云模型；
步骤三、点云防重叠处理：将步骤二中通过点云融合生成单元融合形成机器人A工作空间内的点云模型经过OTCOMAP转换单元转换成八叉树的形式，然后通过位姿融合单元对位姿进行融合；
步骤四、机器人路线的规划：结合步骤三中的通过位姿融合单元中融合的位姿关系，对机器人的路线进行规划，机器人在此空间内根据不同的目标点进行避障路径规划，当出现新的物体出阻碍在机器人前进的路径上时，通过路线重新规划单元重新规划机器人的路径，避开障碍，当障碍物距离机器人过近，使得机器人无法调整新的运行轨迹时，提前控制机器人减速停止，重新启动后规划路线。


2.根据权利要求1所述的一种基于立体视觉的机器人主动避障规...

【专利技术属性】
技术研发人员：曹念，王龙祥，肖海峰，赵云涛，
申请(专利权)人：武汉海默机器人有限公司，
类型：发明
国别省市：湖北;42