[发明专利]一种线阵相机在搭载平台定位坐标系下的偏移位置标定方法在审
申请号: | 202111113158.6 | 申请日: | 2021-09-24 |
公开(公告)号: | CN113850873A | 公开(公告)日: | 2021-12-28 |
发明(设计)人: | 邓勇军;杨睿;李鹏程;李运;桂仲成 | 申请(专利权)人: | 成都圭目机器人有限公司 |
主分类号: | G06T7/80 | 分类号: | G06T7/80;G06T7/70 |
代理公司: | 重庆卓茂专利代理事务所(普通合伙) 50262 | 代理人: | 许冲 |
地址: | 610000 四川省成都市龙*** | 国省代码: | 四川;51 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 相机 搭载 平台 定位 坐标系 偏移 位置 标定 方法 | ||
1.一种线阵相机在搭载平台定位坐标系下的偏移标定方法,其特征在于,所述步骤如下:
S1、将线阵相机的采样线与搭载平台的行进轴进行垂直安装,同时将搭载平台的卫星接收天线以搭载平台行进轴垂直对称安装;
S2、沿着平直路面随机设置多个标记点,通过搭载平台的卫星定位装置静态标记各个标记点的经纬度坐标(BTi,LTi);
S3、搭载平台在目标区域行进并采集标记点线阵相机的图像数据,线阵相机时刻记录每条采样线与搭载平台的坐标位置(BRj,LRj)与航向角θj;
S4、识别每个图像的标记点,获得标记点的采样线位置和偏移采样线中心距离s;
S5、通过偏移采样线中心位置和采样线位置确定标定目标点所在采样线所对应的搭载平台的坐标位置(BRk,LRk)和航向角θk;
S6、计算标定目标点的坐标,计算公式如下:
(BTi,LTi)为已知标记点静态测量经纬度坐标,对所有坐标点进行计算,计算公式如下:
其中:
bi11=sinθk
bi12=cosθk
ci1=BTi-BRk+s*sinθk
bi21=-cosθk
bi22=sinθk
ci2=LTi-LRk-s*cosθk
通过对所有标记点进行计算,获取矩阵公式:
B*D=C
其中:
运用最小二乘法导出为线性平方差计算形式为:
最优解为:
D=(BTB)-1BTC
计算得出线阵相机在搭载平台定位坐标系下的偏移坐标(dx,dy)。
2.根据权利要求1所述的一种线阵相机在搭载平台定位坐标系下的偏移标定方法,其特征在于,每个所述标记点为粘在路面上的圆形铁片,每个所述标记点直径为5cm。
3.根据权利要求1所述的一种线阵相机在搭载平台定位坐标系下的偏移标定方法,其特征在于,所述每个图像的标记点通过图像识别算法识别。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于成都圭目机器人有限公司,未经成都圭目机器人有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111113158.6/1.html,转载请声明来源钻瓜专利网。