一种巡检机器人机械臂末端空间定位方法技术

本发明专利技术公开了一种巡检机器人机械臂末端空间定位方法，属于巡检机器人机械臂末端定位方法领域；其方法，包括步骤1：通过调整坐标使机械臂末端平行于地面；步骤2：通过视觉传感器获取地面特征识别结果，机械臂根据地面特征识别结果平行于地面移至末端预置点完成第一次2D视觉定位；步骤3：保持预置点坐标不变旋转所需俯仰角度使视觉传感器平行操作面；步骤4：通过视觉传感器获取操作面特征识别结果，根据操作面特征识别结果调整机械臂末端使其到达操作面预置点完成第二次2D视觉定位；本发明专利技术通过基于平面进行两次2D视觉定位并调整，避免了采用一次2D视觉定位精度低、采用2D视觉结合距离传感器成本高的缺点，降低了定位成本且实现精准的空间定位。

A Space Location Method for the End of Robot Arm for Patrol Inspection

The invention discloses a space positioning method for the end of a robotic arm of a patrol robot, which belongs to the field of the end positioning method of a robotic arm of a patrol robot. The method comprises steps 1: paralleling the end of a robotic arm to the ground by adjusting coordinates; step 2: obtaining the ground feature recognition result through a visual sensor, and the robotic arm according to the ground. The results of feature recognition move parallel to the ground to the end of the preset point to complete the first 2D visual positioning; Step 3: Keep the preset point coordinates unchanged and rotate the required pitch angle to make the visual sensor parallel to the operating surface; Step 4: Obtain the feature recognition results of the operating surface through the visual sensor, and adjust the manipulator according to the result of the feature recognition of the operating surface. The terminal makes it reach the preset point of the operating surface to complete the second 2D visual positioning; the invention avoids the shortcomings of low precision of using one-time 2D visual positioning and high cost of using two-dimensional vision combined with distance sensor, reduces the cost of positioning and realizes accurate spatial positioning by two-time 2D visual positioning and adjustment based on the plane.

【技术实现步骤摘要】
一种巡检机器人机械臂末端空间定位方法
本专利技术属于巡检机器人机械臂末端定位方法领域，尤其是一种巡检机器人机械臂末端空间定位方法。
技术介绍
近年来，随着机器人行业的发展，安防巡检类机器人在大型厂房、车间、变电站等各个领域兴起，巡检机器人系统的出现，节省大量的人力、物力和财力，尤其对于高危场所的巡检，巡检机器人成为最佳方案。目前，巡检机器人系统已经能够识别各类仪表、防火预警等工作。除此之外，巡检机器人搭载机械臂之后，便能够对现场进行各种操作。目前大多数基于激光雷达SLAM导航的巡检机器人的定位精度低，带来的误差在几厘米到十几厘米，无法做到零误差，不足以满足机械臂操作要求；机械臂要求基座处于固定位置，从而才能保证末端工具运动的轨迹及位姿固定。当巡检机器人导航出现偏差时即实际停止位置与示教停止位置产生偏差，基座的位置与示教位置不同，从而末端工具的位姿与示教位置不同，导致无法正确执行相关操作设备的指令。现有技术中利用2D视觉一次定位方法，无法对空间进行准确定位，仅能在平面内保证准确，无法保证深度方向距离、位置角与示教点一致；利用2D视觉与距离检测传感器的结合方法或3D视觉定位，因需要同时设置视觉组件和测距组件导致成本较高。因此，需要一种机械臂末端空间定位方法可以保证测量精度的同时降低成本。
技术实现思路
本专利技术的目的在于：本专利技术提供了一种巡检机器人机械臂末端空间定位方法，解决现有机械臂末端空间定位采用一次2D视觉定位精度低、采用2D视觉结合距离传感器成本高的问题。本专利技术采用的技术方案如下：一种巡检机器人机械臂末端空间定位方法，包括如下步骤：步骤1：通过调整坐标使机械臂末端平行于地面；步骤2：通过视觉传感器获取地面特征识别结果，机械臂根据地面特征识别结果平行于地面移至末端预置点完成第一次2D视觉定位；步骤3：保持预置点坐标不变旋转所需俯仰角度使视觉传感器平行操作面；步骤4：通过视觉传感器获取操作面特征识别结果，根据操作面特征识别结果调整机械臂末端使其到达操作面预置点完成第二次2D视觉定位。优选地，所述步骤1调整坐标包括设置末端的沿Y轴的旋转矢量即Ry＝0°，沿X轴的旋转矢量即Rx＝90°。优选地，所述步骤2中的地面特征包括地面设置的点或者线或者符号，所述操作面特征包括操作面设置的点或者线或者符号。优选地，所述步骤3中俯仰角度的取值范围为N*90°(0≤N≤3)。优选地，所述步骤3中旋转方向采用逆时针或者顺时针。综上所述，由于采用了上述技术方案，本专利技术的有益效果是：1.本专利技术通过基于平面进行两次2D视觉定位并调整，实现机械臂末端的工具的位置、姿态与目标位姿一致，消除机器人导航及运动误差，避免了采用一次2D视觉定位精度低、采用2D视觉结合距离传感器成本高的缺点；达到了降低定位成本、提高末端空间定位精度的效果；2.本专利技术通过第一次2D视觉定位末端预置点，第二次2D视觉定位操作面预置点，不仅保证平面准确度，又保证了深度方向距离和位置与示教点一致，实现利用两次2D视觉定位提高空间定位精度的同时节约成本；3.本专利技术通过设置的坐标对应调整末端平行地面，保证第一次2D视觉定位的准确度；通过操作面在机械臂的位置对应旋转俯仰角度，防止因位置带来的误差，进一步提高机械臂末端空间定位精度；4.本专利技术通过固定设置的操作面与操作面预置点保证机械臂末端定位的位置，通过固定的两个参数确定了定位的唯一性，进一步提高了机械臂末端空间定位的精度。附图说明为了更清楚地说明本专利技术实施例的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，应当理解，以下附图仅示出了本专利技术的某些实施例，因此不应被看作是对范围的限定，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他相关的附图。图1为本专利技术的方法流程图；图2为本专利技术的巡检机器人结构示意图；图3为本专利技术的机械臂结构示意图；图4为本专利技术的实施例1视觉传感器平行地面时操作示意图；图5为本专利技术的实施例1视觉传感器平行操作面时操作示意图；图6为本专利技术的测试数据表。附图标记：1-运动系统，2-导航系统，3-云台及视觉系统，4-机械臂，5-通信系统，6-2D视觉传感器，7-工具安装更换系统，8-操作工具，9-基座，10-地面特征，11-开关柜，12-操作面特征。具体实施方式为了使本专利技术的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本专利技术进行进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本专利技术，并不用于限定本专利技术，即所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。通常在此处附图中描述和示出的本专利技术实施例的组件可以以各种不同的配置来布置和设计。因此，以下对在附图中提供的本专利技术的实施例的详细描述并非旨在限制要求保护的本专利技术的范围，而是仅仅表示本专利技术的选定实施例。基于本专利技术的实施例，本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例，都属于本专利技术保护的范围。需要说明的是，术语“第一”和“第二”等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。技术问题：解决现有机械臂末端空间定位采用一次2D视觉定位精度低、采用2D视觉结合距离传感器成本高的问题。技术手段：一种巡检机器人机械臂末端空间定位方法，包括如下步骤：步骤1：通过调整坐标使机械臂末端平行于地面；步骤2：通过视觉传感器获取地面特征识别结果，机械臂根据地面特征识别结果平行于地面移至末端预置点完成第一次2D视觉定位；步骤3：保持预置点坐标不变旋转所需俯仰角度使视觉传感器平行操作面；步骤4：通过视觉传感器获取操作面特征识别结果，根据操作面特征识别结果调整机械臂末端使其到达操作面预置点完成第二次2D视觉定位。步骤1调整坐标包括设置末端的沿Y轴的旋转矢量即Ry＝0°，沿X轴的旋转矢量即Rx＝90°。步骤2中的地面特征包括地面设置的点或者线或者符号，所述操作面特征包括操作面设置的点或者线或者符号。步骤3中俯仰角度的取值范围为N*90°(0≤N≤3)。步骤3中旋转方向采用逆时针或者顺时针。技术效果：通过基于平面进行两次2D视觉定位并调整，实现机械臂末端的工具的位置、姿态与目标位姿一致，消除机器人导航及运动误差，避免了采用一次2D视觉定位精度低、采用2D视觉结合距离传感器成本高的缺点；达到了降低定位成本、末端空间定位精度达到亚像素级的效果。以下结合实施例对本专利技术的特征和性能作进一步的详细描述。实施例1巡检机器人需要对开关柜11进行分闸操作，巡检机器人利用激光雷达导航来到被操作设备附近，因导航精度及运动控制精度造成实际位置与预置位存在偏差。首先调整机械臂最末端关节，保持末端的沿Y轴的旋转矢量即Ry＝0°，沿X轴的旋转矢量即Rx＝90°，使视觉传感器平行于地面即平行本文档来自技高网...

【技术保护点】
1.一种巡检机器人机械臂末端空间定位方法，其特征在于：包括如下步骤：步骤1：通过调整坐标使机械臂末端平行于地面；步骤2：通过视觉传感器获取地面特征识别结果，机械臂根据地面特征识别结果平行于地面移至末端预置点完成第一次2D视觉定位；步骤3：保持预置点坐标不变旋转所需俯仰角度使视觉传感器平行操作面；步骤4：通过视觉传感器获取操作面特征识别结果，根据操作面特征识别结果调整机械臂末端使其到达操作面预置点完成第二次2D视觉定位。

【技术特征摘要】
1.一种巡检机器人机械臂末端空间定位方法，其特征在于：包括如下步骤：步骤1：通过调整坐标使机械臂末端平行于地面；步骤2：通过视觉传感器获取地面特征识别结果，机械臂根据地面特征识别结果平行于地面移至末端预置点完成第一次2D视觉定位；步骤3：保持预置点坐标不变旋转所需俯仰角度使视觉传感器平行操作面；步骤4：通过视觉传感器获取操作面特征识别结果，根据操作面特征识别结果调整机械臂末端使其到达操作面预置点完成第二次2D视觉定位。2.根据权利要求1所述的一种巡检机器人机械臂末端空间定位方法，其特征在于：所述步骤1...

【专利技术属性】
技术研发人员：马力，赵灿辉，王致，李骞，徐肖庆，
申请(专利权)人：云南电网有限责任公司昆明供电局，
类型：发明
国别省市：云南,53