一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

一种用于巡检机器人采集目标物图像的方法与流程

2022-06-08 08:56:16 来源:中国专利 TAG:

1.本发明涉及一种用于巡检机器人采集目标物图像的方法。


背景技术:

2.巡检机器人在自主执行拍摄目标物过程中,需要调整云台调节位姿,而现有技术中,由于机器人的定位误差以及云台调节位姿的运动误差,导致机器人拍摄的图片与预期不一致,通常会出现拍不到或拍不全目标物的情况,影响最终的巡检质量。


技术实现要素:

3.针对“由于机器人的定位误差以及云台调节位姿的运动误差,导致机器人拍摄的图片与预期不一致,通常会出现拍不到或拍不全目标物的情况,影响最终的巡检质量的缺陷”,本发明提供了一种用于巡检机器人采集目标物图像的方法,是通过如下方案实现的。
4.一种用于巡检机器人采集目标物图像的方法,包括步骤s1;
5.s1:计算云台拍摄目标物的位姿参数;
6.在s1中,具体包括以下步骤:
7.s11:获取目标物与云台在地图的定位坐标,分别为t,p以及云台相对地图坐标的实时偏转角α;
8.s12:获取云台旋转轴单位向量v1:
9.s13:计算目标物与云台坐标的空间向量v2:
10.s14:采用和θ=arccos(cosθ)计算得出目标物与云台的空间偏转夹角θ;
11.s15:分别以xoy和yoz为投影面,目标物与云台的空间偏转夹角θ分解得到目标物与云台的水平夹角θh和垂直夹角θv,计算向量外积得到旋转角度的方向,从而得到云台坐标相对目标物坐标的顺时针旋转角为-θh,-θv,逆时针旋转角为θh,θv,计算云台实际水平偏转角
12.本发明的有益效果在于:本发明所提方法结合空间定位坐标,调节拍摄目标物的位姿参数,相比与现有技术中单纯模板匹配校准云台位姿参数而言,鲁棒性更高,利用本发明方法得到的位姿参数对云台进行调节对准目标物进行拍摄,可以避免云台调节位姿的运动误差,提高最终的巡检质量。
具体实施方式
13.以下结合实施例对本发明作进一步的阐述,所述的实施例仅为本发明一部分的实
施例,这些实施例仅用于解释本发明,对本发明的范围并不构成任何限制。
14.本发明提供一种用于巡检机器人采集目标物图像的方法,包括步骤s1;
15.s1:计算云台拍摄目标物的位姿参数:
16.在s1中,具体包括以下步骤:
17.s11:获取目标物与云台在地图的定位坐标,分别为t,p以及云台相对地图坐标的实时偏转角α;
18.s12:根据云台的实时偏转角α,得到云台旋转轴的单位向量v1:目的是确定最小旋转角度;
19.s13:计算目标物与云台坐标的空间向量v2:
20.s14:采用和θ=arccos(cosθ)计算得出目标物与云台的空间偏转夹角θ;
21.s15:为了得到云台水平和垂直两个维度的位姿参数,分别以xoy和yoz为投影面,目标物与云台的空间偏转夹角θ分解得到目标物与云台的水平夹角θh和垂直夹角θv,计算向量外积得到旋转角度的方向,从而得到云台坐标相对目标物坐标的顺时针旋转角为-θh,-θv,逆时针旋转角为θh,θv。为了使旋转抵消云台自身的水平偏转角,计算云台实际水平偏转角为最后根据云台的规格参数,从旋转角转换得到云台的位姿参数,就可以调节云台对准目标物。
22.本发明所提方法结合空间定位坐标,调节拍摄目标物的位姿参数,相比与现有技术中单纯模板匹配校准云台位姿参数而言,鲁棒性更高,利用本发明方法得到的位姿参数对云台进行调节对准目标物进行拍摄,可以避免机器人的定位误差以及云台调节位姿的运动误差,提高最终的巡检质量。
23.以上所述,仅是本发明的较佳实施例而已,并非对本发明作任何形式上的限制,虽然本发明已以较佳实施例揭露如上,然而并非用以限定本发明,任何熟悉本专业的技术人员,在不脱离本发明技术方案范围内,当可利用上述揭示的技术内容作出些许更动或修饰为等同变化的等效实施例,但凡是未脱离本发明技术方案内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化与修饰,均仍属于本发明技术方案的范围内。


技术特征:
1.一种用于巡检机器人采集目标物图像的方法,其特征在于:包括步骤s1;s1:计算云台拍摄目标物的位姿参数;在s1中,具体包括以下步骤:s11:获取目标物与云台在地图的定位坐标,分别为t,p以及云台相对地图坐标的实时偏转角α;s12:获取云台旋转轴单位向量v1:s13:计算目标物与云台坐标的空间向量v2:s14:采用和θ=arccos(cosθ)计算得出目标物与云台的空间偏转夹角θ;s15:分别以xoy和yoz为投影面,目标物与云台的空间偏转夹角θ分解得到目标物与云台的水平夹角θ
h
和垂直夹角θ
v
,计算向量外积得到旋转角度的方向,从而得到云台坐标相对目标物坐标的顺时针旋转角为-θ
h
,-θ
v
,逆时针旋转角为θ
h
,θ
v
,计算云台实际水平偏转角

技术总结
本发明提供一种用于巡检机器人采集目标物图像的方法,包括步骤S1;S1:计算云台拍摄目标物的位姿参数;在S1中,具体包括以下步骤:S11:获取目标物与云台在地图的定位坐标,分别为T,P以及云台相对地图坐标的实时偏转角α;S12:获取云台旋转轴单位向量v1:S13:计算目标物与云台坐标的空间向量v2:S14:采用和θ=arccos(cosθ)计算得出目标物与云台的空间偏转夹角θ;S15:分别以xoy和yoz为投影面,目标物与云台的空间偏转夹角θ分解得到目标物与云台的水平夹角θ


技术研发人员:邹婉欣 粟玉雄 张义杰
受保护的技术使用者:深圳市千乘机器人有限公司
技术研发日:2022.03.04
技术公布日:2022/6/7
再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献