CN106996769B - 一种无需相机标定的主动式位姿快速重定位方法 - Google Patents
一种无需相机标定的主动式位姿快速重定位方法 Download PDFInfo
- Publication number
- CN106996769B CN106996769B CN201710176001.5A CN201710176001A CN106996769B CN 106996769 B CN106996769 B CN 106996769B CN 201710176001 A CN201710176001 A CN 201710176001A CN 106996769 B CN106996769 B CN 106996769B
- Authority
- CN
- China
- Prior art keywords
- point
- ordinate
- moving
- camera
- abscissa
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
- G06F17/12—Simultaneous equations, e.g. systems of linear equations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Theoretical Computer Science (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Operations Research (AREA)
- Multimedia (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computing Systems (AREA)
- Studio Devices (AREA)
- Image Analysis (AREA)
Abstract
一种无需相机标定的主动式位姿快速重定位方法:判断是否符合设定的重定位标准,如果符合重定位标准,结束流程;否则进入下一步骤:计算单应变换矩阵H,是提取当前图像与参考图相匹配的特征点对,根据所提取的特征点对计算单应变换矩阵H;根据求解后的单应变换矩阵H动态更新指示框;根据动态更新后的指示框,提到调整控制摄像机六个自由度运动的指标,所述的六个自由度包括:抬头/低头、左转/右转、左摆/右摆、左移/右移、上移/下移、前移/后移;根据调整控制摄像机六个自由度运动的指标进行相机位姿调整;重复步骤上述过程,直到符合重定位标准,结束。本发明实时性好、灵活性高、定位精度较高、对光照条件不敏感、适用于室内外各种工作环境。
Description
技术领域
本发明涉及一种位姿快速重定位方法。特别是涉及一种无需相机标定的主动式位姿快速重定位方法。
背景技术
(1)SIFT:Scale Invariant Feature Transform的简称,一种计算机视觉中的算法。用来侦测与描述图像中的局部性特征。它在空间尺度中寻找极值点并提取出其位置、尺度、旋转不变量。局部影像特征的描述与侦测可以帮助辨识物体,SIFT特征是基于物体上的一些局部外观的兴趣点而与影像的大小和旋转无关。对于光线、噪声、一些视角改变的容忍度也相当高。对于这些特性,它们是高度显著而且相对容易获得的。使用SIFT特征描述对于部分物体遮蔽的侦测率也相当高,甚至只需要3个以上的SIFT物体特征就足以计算出位置与方位,辨识速度也可接近即时运算。
(2)DLT(参见文献[1]):Direct Linear Transform的简称,一个用于解决包含尺度问题的最小二乘问题的算法,通过DLT法求出初值,再用牛顿法迭代求解。简单来说,就是通过两张图像矩阵,求解其两个矩阵的单应变换矩阵。
DLT解决问题的标准形式为:
Xk∝A*Yk (1)
另一种表现形式为:
Xk=a*A*Yk或者a*Xk=A*Yk (2)。
上述两个技术虽然比较成熟,但是它们只是应用于图像处理的技术,无法解决主动式位姿重定位这一课题。
发明内容
本发明所要解决的技术问题是,提供一种具有实时性好、灵活性高、定位精度较高的无需相机标定的主动式位姿快速重定位方法。
本发明所采用的技术方案是:一种无需相机标定的主动式位姿快速重定位方法,包括如下步骤:
1)判断是否符合设定的重定位标准,如果符合重定位标准,结束流程;如果不符合重定位标准,进入下一步骤:
2)计算单应变换矩阵H,是提取当前图像与参考图相匹配的特征点对,根据所提取的特征点对计算单应变换矩阵H;
3)根据求解后的单应变换矩阵H动态更新指示框,包括:
在参考图像中构造一个以参考图像为中心位置的指示框,得到第三矩阵,将第三矩阵与步骤2)求出的单应变换矩阵H相乘,得到第四矩阵,即为动态更新后的指示框;
4)根据动态更新后的指示框,提到调整控制摄像机六个自由度运动的指标,所述的六个自由度包括:抬头/低头、左转/右转、左摆/右摆、左移/右移、上移/下移、前移/后移;
5)根据调整控制摄像机六个自由度运动的指标进行相机位姿调整;
6)重复步骤1)~步骤5),直到符合重定位标准,结束。
步骤2)包括:
分别找出当前图像若干个点的坐标(x,y,z),构成第一矩阵,再分别找出参考图像中与当前图像若干个点的坐标(x,y,z)相匹配的若干个点的坐标(x',y',z'),构成第二矩阵,得出如下等式:
H*[x,y,z]T=[x',y',z']T
利用直接线性变换算法,通过多个等式组成的方程组,求解得出变换矩阵H。
步骤4)包括:
(1)首先从动态更新后的指示框左上角顶点开始,设定四个顶点顺时针依次为点0、点1、点2和点3,将以所述指示框中心为中心点画出十字,设定十字中的横线左端点为点4,右端点为点5;
(2)根据动态更新后的指示框,得到调整控制摄像机六个自由度运动的指标。
第(2)中步6个自由度的调整依据是:
抬头:第一个点的横坐标-第零个点的横坐标>第二个点的横坐标-第三个点的横坐标;
低头:第一个点的横坐标-第零个点的横坐标<第二个点的横坐标-第三个点的横坐标;
左转:第三个点的纵坐标-第零个点的纵坐标<第二个点的纵坐标-第一个点的纵坐标;
右转:第三个点的纵坐标-第零个点的纵坐标>第二个点的纵坐标-第一个点的纵坐标;
左摆:第五个点的纵坐标-第四个点的纵坐标<0;
右摆:第五个点的纵坐标-第四个点的纵坐标>0;
左移:参考图的中心点x轴坐标<当前图的中心点x轴坐标;
右移:参考图的中心点x轴坐标>当前图的中心点x轴坐标;
上移:参考图的中心点y轴坐标>当前图的中心点y轴坐标;
下移:参考图的中心点y轴坐标<当前图的中心点y轴坐标;
前移:参考图的导航框面积<当前图的导航框面积;
后移:参考图的导航框面积>当前图的导航框面积。
本发明的一种无需相机标定的主动式位姿快速重定位方法,具有实时性好、灵活性高、定位精度较高、对光照条件不敏感、适用于室内外各种工作环境等突出优点。特别适用于以室外文物为代表的高值目标本体微小变化监测任务中的数据精确采集需求。
附图说明
图1是本发明一种无需相机标定的主动式位姿快速重定位方法的流程图;
图2是移动前拍摄结果图;
图3是移动过程某个时刻拍摄结果图;
图4是重定位方法结束后拍摄结果图。
具体实施方式
下面结合实施例和附图对本发明的一种无需相机标定的主动式位姿快速重定位方法做出详细说明。
本发明的一种无需相机标定的主动式位姿快速重定位方法,通过计算当前状态下拍摄图像与上次状态下图像之间的单应变换关系,反馈出六个自由度的移动控制变量,指导操作者或执行机构向正确方向移动。
如图1所示,本发明的一种无需相机标定的主动式位姿快速重定位方法,包括如下步骤:
1)判断是否符合设定的重定位标准,这种主动式相机位姿快速重定位存在一种结束标准,在开始时,需要对当前状态与标准对比,如果符合重定位标准,结束流程;如果不符合重定位标准,进入下一步骤:
2)计算单应变换矩阵H,是提取当前图像与参考图相匹配的特征点对,根据所提取的特征点对计算单应变换矩阵H;包括:
分别找出当前图像若干个点的坐标(x,y,z),构成第一矩阵,再分别找出参考图像中与当前图像若干个点的坐标(x,y,z)相匹配的若干个点的坐标(x',y',z'),构成第二矩阵,得出如下等式:
H*[x,y,z]T=[x',y',z']T
利用直接线性变换算法,通过多个等式组成的方程组,求解得出变换矩阵H。
3)根据求解后的单应变换矩阵H动态更新指示框,包括:
在参考图像中构造一个以参考图像为中心位置的指示框,得到第三矩阵,将第三矩阵与步骤2)求出的单应变换矩阵H相乘,得到第四矩阵,即为动态更新后的指示框;
4)根据动态更新后的指示框,提到调整控制摄像机六个自由度运动的指标,所述的六个自由度包括:抬头/低头、左转/右转、左摆/右摆、左移/右移、上移/下移、前移/后移;具体包括:
(1)首先从动态更新后的指示框左上角顶点开始,设定四个顶点顺时针依次为点0、点1、点2和点3,将以所述指示框中心为中心点画出十字,设定十字中的横线左端点为点4,右端点为点5;
(2)根据动态更新后的指示框,得到调整控制摄像机六个自由度运动的指标。
6个自由度的调整依据是:
抬头:第一个点的横坐标-第零个点的横坐标>第二个点的横坐标-第三个点的横坐标;
低头:第一个点的横坐标-第零个点的横坐标<第二个点的横坐标-第三个点的横坐标;
左转:第三个点的纵坐标-第零个点的纵坐标<第二个点的纵坐标-第一个点的纵坐标;
右转:第三个点的纵坐标-第零个点的纵坐标>第二个点的纵坐标-第一个点的纵坐标;
左摆:第五个点的纵坐标-第四个点的纵坐标<0;
右摆:第五个点的纵坐标-第四个点的纵坐标>0;
左移:参考图的中心点x轴坐标<当前图的中心点x轴坐标;
右移:参考图的中心点x轴坐标>当前图的中心点x轴坐标;
上移:参考图的中心点y轴坐标>当前图的中心点y轴坐标;
下移:参考图的中心点y轴坐标<当前图的中心点y轴坐标;
前移:参考图的导航框面积<当前图的导航框面积;
后移:参考图的导航框面积>当前图的导航框面积。
5)根据调整控制摄像机六个自由度运动的指标进行相机位姿调整;
6)重复步骤1)~步骤5),直到符合重定位标准,结束。
图2所示是使用本发明的方法之前相机显示的界面,其定位的效果明显很差。
图3所示是使用本发明的方法过程中相机的显示界面,此时正在向本发明想要的效果中运动。
图4所示是使用本发明的方法结束后显示的界面,此时重定位的效果就很好了。
由上明显可以看到,使用本发明的方法得到的重定位效果非常好,已基本达到完全重定位效果。
Claims (1)
1.一种无需相机标定的主动式位姿快速重定位方法,其特征在于,包括如下步骤:
1)判断是否符合设定的重定位标准,如果符合重定位标准,结束流程;如果不符合重定位标准,进入下一步骤;
2)计算单应变换矩阵H,是提取当前图像与参考图相匹配的特征点对,根据所提取的特征点对计算单应变换矩阵H,包括:
分别找出当前图像若干个点的坐标(x,y,z),构成第一矩阵,再分别找出参考图像中与当前图像若干个点的坐标(x,y,z)相匹配的若干个点的坐标(x',y',z'),构成第二矩阵,得出如下等式:
H*[x,y,z]T=[x',y',z']T
利用直接线性变换算法,通过多个等式组成的方程组,求解得出变换矩阵H;
3)根据求解后的单应变换矩阵H动态更新指示框,包括:
在参考图像中构造一个以参考图像为中心位置的指示框,得到第三矩阵,将第三矩阵与步骤2)求出的单应变换矩阵H相乘,得到第四矩阵,即为动态更新后的指示框;
4)根据动态更新后的指示框,提到调整控制摄像机六个自由度运动的指标,所述的六个自由度包括:抬头/低头、左转/右转、左摆/右摆、左移/右移、上移/下移、前移/后移,包括:
(1)首先从动态更新后的指示框左上角顶点开始,设定四个顶点顺时针依次为点0、点1、点2和点3,将以所述动态更新后的指示框中心为中心点画出十字,设定十字中的横线左端点为点4,右端点为点5;
(2)根据动态更新后的指示框,得到调整控制摄像机六个自由度运动的指标——所述6个自由度的调整依据是:
抬头:点1的横坐标-点0的横坐标>点2的横坐标-点3的横坐标;
低头:点1的横坐标-点0的横坐标<点2的横坐标-点3的横坐标;
左转:点3的纵坐标-点0的纵坐标<点2的纵坐标-点1的纵坐标;
右转:点3的纵坐标-点0的纵坐标>点2的纵坐标-点1的纵坐标;
左摆:点5的纵坐标-点4的纵坐标<0;
右摆:点5的纵坐标-点4的纵坐标>0;
左移:参考图的中心点x轴坐标<当前图的中心点x轴坐标;
右移:参考图的中心点x轴坐标>当前图的中心点x轴坐标;
上移:参考图的中心点y轴坐标>当前图的中心点y轴坐标;
下移:参考图的中心点y轴坐标<当前图的中心点y轴坐标;
前移:参考图的导航框面积<当前图的导航框面积;
后移:参考图的导航框面积>当前图的导航框面积;
5)根据调整控制摄像机六个自由度运动的指标进行摄像机位姿调整;
6)重复步骤1)~步骤5),直到符合重定位标准,结束。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710176001.5A CN106996769B (zh) | 2017-03-22 | 2017-03-22 | 一种无需相机标定的主动式位姿快速重定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710176001.5A CN106996769B (zh) | 2017-03-22 | 2017-03-22 | 一种无需相机标定的主动式位姿快速重定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106996769A CN106996769A (zh) | 2017-08-01 |
CN106996769B true CN106996769B (zh) | 2020-02-14 |
Family
ID=59431487
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710176001.5A Active CN106996769B (zh) | 2017-03-22 | 2017-03-22 | 一种无需相机标定的主动式位姿快速重定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106996769B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107843240B (zh) * | 2017-09-14 | 2020-03-06 | 中国人民解放军92859部队 | 一种海岸带区域无人机影像同名点信息快速提取方法 |
CN110555883B (zh) | 2018-04-27 | 2022-07-22 | 腾讯科技(深圳)有限公司 | 相机姿态追踪过程的重定位方法、装置及存储介质 |
CN108764152B (zh) * | 2018-05-29 | 2020-12-04 | 北京物灵智能科技有限公司 | 基于图片匹配实现互动提示的方法、装置及存储设备 |
CN113343739B (zh) * | 2020-03-02 | 2022-07-22 | 杭州萤石软件有限公司 | 可移动设备的重定位方法和可移动设备 |
CN117036474A (zh) * | 2023-08-08 | 2023-11-10 | 天津大学 | 一种面向微观尺度的主动相机重定位方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101441769A (zh) * | 2008-12-11 | 2009-05-27 | 上海交通大学 | 单目摄像机实时视觉定位方法 |
EP2444361A2 (de) * | 2010-10-22 | 2012-04-25 | Gerald Fuxjäger | Brücken-Untersichtgerät |
CN103900535A (zh) * | 2014-03-10 | 2014-07-02 | 天津大学 | 面向文物微小变化检测的相机四点重定位方法 |
CN105956074A (zh) * | 2016-04-28 | 2016-09-21 | 北京航空航天大学 | 邻近位姿融合引导的单幅图像场景六自由度定位方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102937816B (zh) * | 2012-11-22 | 2015-05-27 | 四川华雁信息产业股份有限公司 | 摄像机预置位偏差校准方法及装置 |
-
2017
- 2017-03-22 CN CN201710176001.5A patent/CN106996769B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101441769A (zh) * | 2008-12-11 | 2009-05-27 | 上海交通大学 | 单目摄像机实时视觉定位方法 |
EP2444361A2 (de) * | 2010-10-22 | 2012-04-25 | Gerald Fuxjäger | Brücken-Untersichtgerät |
CN103900535A (zh) * | 2014-03-10 | 2014-07-02 | 天津大学 | 面向文物微小变化检测的相机四点重定位方法 |
CN105956074A (zh) * | 2016-04-28 | 2016-09-21 | 北京航空航天大学 | 邻近位姿融合引导的单幅图像场景六自由度定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106996769A (zh) | 2017-08-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106996769B (zh) | 一种无需相机标定的主动式位姿快速重定位方法 | |
CN110136208B (zh) | 一种机器人视觉伺服***的联合自动标定方法及装置 | |
US11875537B2 (en) | Multi view camera registration | |
CN106097300B (zh) | 一种基于高精度运动平台的多相机标定方法 | |
WO2022120567A1 (zh) | 一种基于视觉引导的自动化标定*** | |
CN104933718B (zh) | 一种基于双目视觉的物理坐标定位方法 | |
CN107471218B (zh) | 一种基于多目视觉的双臂机器人手眼协调方法 | |
CN114399554B (zh) | 一种多相机***的标定方法及*** | |
CN107256567B (zh) | 一种用于工业机器人手眼相机的自动标定装置及标定方法 | |
CN110728715A (zh) | 一种智能巡检机器人像机角度自适应调整方法 | |
TWI677413B (zh) | 用於機械手臂系統之校正方法及裝置 | |
CN104200454B (zh) | 鱼眼图像畸变校正方法及装置 | |
JP7185860B2 (ja) | 多軸可動視覚システムのキャリブレーション方法 | |
TWI526879B (zh) | 互動系統、遙控器及其運作方法 | |
JP4395689B2 (ja) | 画像データ処理方法およびモデリング装置 | |
CN106595601B (zh) | 一种无需手眼标定的相机六自由度位姿精确重定位方法 | |
CN110202560A (zh) | 一种基于单个特征点的手眼标定方法 | |
DE102018113336A1 (de) | Verfahren zum Verwenden mit einer Maschine zum Einstellen einer Erweiterte-Realität-Anzeigeumgebung | |
CN110827321A (zh) | 一种基于三维信息的多相机协同的主动目标跟踪方法 | |
CN108596947B (zh) | 一种适用于rgb-d相机的快速目标跟踪方法 | |
CN110928311B (zh) | 一种基于全景相机下直线特征的室内移动机器人导航方法 | |
CN113172659A (zh) | 基于等效中心点识别的柔性机器人臂形测量方法及*** | |
CN113781558B (zh) | 一种姿态与位置解耦的机器人视觉寻位方法 | |
CN107123135B (zh) | 一种无序三维点云的无畸变成像方法 | |
WO2024019899A1 (en) | Virtual production based on display assembly pose and pose error correction |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |