CN109990801B - 基于铅垂线的水平仪装配误差标定方法 - Google Patents
基于铅垂线的水平仪装配误差标定方法 Download PDFInfo
- Publication number
- CN109990801B CN109990801B CN201711473507.9A CN201711473507A CN109990801B CN 109990801 B CN109990801 B CN 109990801B CN 201711473507 A CN201711473507 A CN 201711473507A CN 109990801 B CN109990801 B CN 109990801B
- Authority
- CN
- China
- Prior art keywords
- assembly error
- level
- image
- camera
- matrix
- 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
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/30—Computing systems specially adapted for manufacturing
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Image Analysis (AREA)
Abstract
本发明公开了一种基于铅垂线的水平仪装配误差标定方法。首先,将水平仪与相机固定在实验平台上,使三者组成稳定的固连光电测量***;然后,改变光电测量***的角度,确保视场中有显著的铅垂线,拍摄多张图像,并记录对应的水平仪倾角数据;接着,采用Hough直线检测算法对拍摄的图像进行处理,提取图像中建筑物的铅垂线,记录铅垂线上的坐标点;最后,利用获得的坐标信息和水平仪读数,实现水平仪装配误差矩阵的标定。该方法克服了传统光电测量***中水平仪姿态信息缺乏的限制,采用场景中铅垂线在水平状态下拍摄的相机图像平面上应为竖直线的原理,进行***中水平仪装配误差的标定。
Description
技术领域
本发明属于计算机视觉中图像处理技术领域,具体涉及一种基于铅垂线的水平仪装配误差标定方法。
背景技术
光电测量***通过在固定位置安装可见光或红外CCD实现目标的检测和测量。由于实验场地的差异性,光电测量***在使用时往往需要不同的惯性传感器或者水平仪进行辅助测量,以获取探测器的姿态信息或进行探测器的稳像。随着各种相关装置的不断发展,光电测量***的标定问题成为了国内外研究者讨论的热点话题,并在航空航天、自动化、机器人等领域得到了广泛的应用(Ding J.Research on attitude algorithm based onmicro inertial sensors[D].Shanghai:Shanghai Jiao tong University,2013.)。低成本,高精确度,小型化,低能耗,高载荷等性能,成为了光电测量***的发展方向(Liu X.Theattitude test algorithm based on MEMS multidimensional inertial sensors[D].Harbin:Harbin Engineering University,2013.)。
水平仪作为一种微小倾角的测量工具,能够固定在光电测量***中给出***相对于水平面的姿态变化(Cao J,Zhang L,Wu H,et al.Analytical approach formeasurement of spatial angle with inclination sensor[J].Journal of Xian Jiaotong University,2013.)。待测目标在三维空间中的实际位置坐标可以通过水平仪的倾角信息,辅助图像处理的手法得到(Gang T,Tao W,Zhi-Yong W U,et al.Application ofhigh accuracy inclinometer to deformation measurement for vehicular platform[J].Optics&Precision Engineering,2010,18(6):1347-1353.)。
由于水平仪只能测量装配平面与水平面的夹角,得到水平仪倾角信息,而无法获取***完整的姿态信息,因此,在对***装配误差标定时,一般需要结合惯性传感器进行统一标定。然而,惯性传感器本身的累积误差会影响水平仪的标定精度(Lambrecht S,Nogueira S L,Bortole M,et al.Inertial Sensor Error Reduction throughCalibration and Sensor Fusion.[J].Sensors,2016,16(2).)。此外,高精度精密仪器,如高精度陀螺仪等,加个昂贵,且不便于集成化(1.Barbour N M.Inertial navigationsensors[J].2010;2.Woodman O J,Woodman C O J.An introduction to inertialnavigation[J].Journal of Navigation,2007,9(3):249-259.)。
发明内容
本发明的目的在于提出一种基于铅垂线的水平仪装配误差标定方法。在光电测量***水平仪装配误差标定过程中,采用场景中铅垂线在水平状态拍摄相机图像平面上应为竖直线的原理,并结合水平仪的倾角信息,求取水平仪装配误差矩阵。与传统的光电测量***装配误差标定方法相比,该方法克服了水平仪姿态信息缺乏的限制,能够仅利用拍摄图像中的铅垂线信息和水平仪倾角信息,准确标定出***中水平仪的装配误差,具有一定的可行性。
为了解决上述技术问题,本发明提供一种基于铅垂线的水平仪装配误差标定方法,使用如公式(1)所示的优化方程计算水平仪装配误差矩阵,从而实现水平仪装配误差的标定,
式(1)中,Ric是光电测量***中需要标定的水平仪装配误差矩阵,I为一个3×3的单位矩阵,T表示矩阵的转置;
步骤一:转动光电测量***,获得多组水平仪倾角数据(θi,φi),i=1,2,...,n,同时,采集对应的图像Ii(i=1,2,...,n);
步骤三:建立求解水平仪装配误差的优化方程,求解水平仪装配误差Ric。
本发明与现有技术相比,其显著优点在于:本发明方法克服了传统光电测量***中水平仪姿态信息缺乏的限制,采用场景中铅垂线在水平状态拍摄相机图像平面上应为竖直线的原理,仅利用场景中的铅垂线和水平仪倾角信息,进行水平仪装配误差的标定。经实验证明,本发明提出的方法,能够准确地标定出光电测量***中水平仪的装配误差,具有一定的可行性。
附图说明
图1是本发明基于铅垂线的水平仪装配误差标定方法的流程图。
图2是相机坐标系和水平仪坐标系。
图3是本发明基于铅垂线的水平仪装配误差标定方法的原理图:“场景中铅垂线在水平状态拍摄相机图像平面上应为竖直线”。
图4是大地坐标系和水平仪坐标系。
图5是图像水平校正的流程图。
图6是本发明基于铅垂线的水平仪装配误差标定方法的示意图。
图7是实验装置示意图。
图8是标定使用的棋盘格。
图9是拍摄图像中检测到的场景中的铅垂线。
具体实施方式
一、本发明基本思想
本发明提出了一种基于铅垂线的水平仪装配误差标定方法,其基本思想是:
步骤一:实验***搭建。将水平仪与相机固定在实验平台上,水平仪与相机之间的位置关系不限,组成稳定的固连光电测量***;
步骤二:拍摄图像。改变光电测量***的角度,进行标定图像采集Ii(i=1,2,...,n),在采集过程中,确保视场中存在显著的铅垂线,同时记录对应的水平仪倾角数据(θii,φi),i=1,2,...,n;
步骤四:建立求解水平仪装配误差的优化方程,求解水平仪装配误差。
二、光电测量***中水平仪装配误差的概念
在包含水平仪和相机的光电测量***实际装配过程中,水平仪坐标系与相机坐标系往往并不能够完全重合。图2是相机坐标系和水平仪坐标系。其中,C-XcYcZc,Oi-XiYiZi和c-xy分别表示相机坐标系,水平仪坐标系和图像平面Π。
相机坐标系和水平仪坐标系之间的转换关系可以表示为:
Xi=RicXc+tic, (1)
其中,Xc和Xi分别表示相机坐标系和水平仪坐标系中的点坐标矢量,Ric和tic分别表示相机坐标系到水平仪坐标系的旋转和平移矩阵。在拍摄靶场目标的实际情况下,光电测量***中水平仪和相机之间的距离tic往往要小于光电测量***与待测量目标之间的距离。因此,tic一般可以忽略(Hartley R,Zisserman A.Multiple view geometry incomputer vision[M].Cambridge University Press,2003.)。
本发明定义Ric为光电测量***中的水平仪装配误差,并利用场景中的铅垂线对该误差进行标定。
三、光电测量***中水平仪装配误差标定的概念
水平仪只能够测量两轴(x轴与y轴)与水平面之间的倾角,而无法测量***与正北方向的偏航角,因此在进行水平仪装配误差的标定时,应该避免该自由度。图3是本发明基于铅垂线的水平仪装配误差标定及图像水平校正方法的原理图:“场景中铅垂线在水平状态拍摄相机图像平面上应为竖直线”。o1-x1y1和o2-x2y2分别表示不同旋转状态下的相机坐标系,C表示相机的光心。当相机水平放置时,无论相机的方向如何改变,场景中的铅垂线AB在图像平面上的投影A1B1或A2B2都应该是直线,即在铅垂线AB上的点应该在图像平面上有相同的横坐标
1、大地坐标系与水平仪坐标系转换关系
图4是大地坐标系和水平仪坐标系。其中,O-XgYgZg和O-XiYiZi分别表示大地坐标系和水平仪坐标系。这两个坐标系都为右手坐标系。
构建中间坐标系O-XoYoZo,该坐标系构建方法为:将大地坐标系绕Zg轴旋转α角度,使得Xo轴为Xi轴的投影。在旋转过程中,获得水平仪角度(θ,φ)。
根据几何关系可知,基向量Xi在中间坐标系O-XoYoZo中可以表示为:
Xi=(cosθ,0,sinθ)T. (2)
根据Yi轴与Xi轴的正交性,基向量Yi在中间坐标系O-XoYoZo中可以表示为:
Yi=(-tanθsinφ,ν,sinφ)T, (3)
其中,
则基向量Zi在中间坐标系O-XoYoZo中可以表示为:
则水平仪坐标系与大地坐标系之间的余弦矩阵Rgi可以表示为:
其中,α也可以理解为水平仪Yi轴与正北方向的夹角。改变α的值不会影响水平仪的读数。
2、利用水平仪进行图像水平校正
利用水平仪的倾角信息,并结合坐标转换关系,可以将相机任意角度位置下拍摄的图像校正水平。图5是图像水平校正的流程图。具体的校正步骤为:
步骤一:将相机坐标系旋转到水平仪坐标系,旋转矩阵为公式(1)中的Ric,即为本发明中的水平仪装配误差矩阵;
步骤二:将水平仪坐标系旋转到大地坐标系,旋转矩阵为公式(6)中的Rgi;
步骤三:将大地坐标系旋转到相机水平放置时的水平相机坐标系,旋转矩阵为公式(7)中的Rh:
步骤四:根据多视角几何原理(Hartley R,Zisserman A.Multiple viewgeometry in computer vision[M].Cambridge University Press,2003.),两张图之间的单应性矩阵H12可以被简化为:
H12=KR12K-1, (8)
其中,K是相机的内参矩阵。K可以表示为:
其中,fx和fy分别表示相机的在x和y方向的焦距,cx和cy表示相机的主点。
R12是由图1到图2的旋转矩阵。R12可以表示为:
R12=RhRgiRic=RhRz(α)Ri(θ,φ)Ric. (10)
将公式(10)代入公式(8),则单应性矩阵H12可以表示为:
H12=KR12K-1=KRhRz(α)Ri(θ,φ)RicK-1. (11)
将公式(7)和公式(9)代入公式(11)可得:
最终,将原始图像与单应性矩阵H12相乘可以得到水平校正后的图像
3、基于铅垂线的水平仪装配误差标定
图6是本发明基于铅垂线的水平仪装配误差标定方法的示意图。如图6所示,取相机任意摆放位置拍摄图像中直线L上两点A(x1,y1)和B(x2,y2)。定义A′(x1′,y′1)和B′(x′2,y′2)为经过水平校正后图像中对应直线L′上的点。
根据单应性变换理论,有:
其中,s1和s2为齐次坐标的尺度变化因子。
令:
将公式(13)和公式(15)代入公式(14),有:
将公式(16)展开,又因为x′1=x′2,则有:
X1Y2-X2Y1=0. (17)
从公式(17)中可以看出,公式(6)中定义的角度α在推导过程中被消掉,这也证明了α的大小不影响水平仪的读数。
在实际测量过程中,由于各种误差或干扰因素的影响,公式(17)不一定严格成立。为了得到较为精确的水平仪装配误差Ric,本发明采用最小残差平方和(Simon D,Simon DL.Analytic Confusion Matrix Bounds for Fault Detection and Isolation Using aSum-of-squared-residuals Approach[M]//IEEE Transactions on Reliability.2010:287-296.)的方法求解Ric。该方法具体步骤为:
步骤一:转动光电测量***,获得多组水平仪倾角数据(θi,φi),i=1,2,...,n,同时,采集对应的图像;
步骤三:建立求解水平仪装配误差的优化方程,求解水平仪装配误差Ric。
具体的求解水平仪装配误差Ric方程为:
其中,I为一个3×3的单位矩阵,T表示矩阵的转置。
公式(18)中,优化方程的目标函数为最小残差平方和的形式,约束条件为水平仪装配误差Ric的正交性。因此,公式(18)为一个非线性约束优化方程,待求解的Ric具有三个自由度。为了获得较精确的标定结果,需满足n≥3。
四、执行本发明方法的一个流程
步骤一:实验***搭建。将水平仪与相机固定在实验平台上,水平仪与相机之间的位置关系不限,组成稳定的固连光电测量***;
步骤二:拍摄图像。改变光电测量***的角度,进行标定图像采集Ii(i=1,2,...,n),在采集过程中,确保视场中存在显著的铅垂线,同时记录对应的水平仪倾角数据(θi,φi),i=1,2,...,n;
步骤四:建立求解水平仪装配误差的优化方程,求解水平仪装配误差Ric。
本发明的有益效果可以通过以下实验进一步说明:
1、光电测量***的组成及***初值
本实验光电测量***由一个相机和一个水平仪固连组成。实验装置如图7所示。
采用Vieworks公司高分辨率工业相机CCD VC-12MC-65,Zeiss公司35mm长焦镜头。相机各参数如表1所示。
表1相机参数
采用西安西光创威光电公司水平仪,角分辨率为3分。水平仪读数为16位有符号数,以度为单位的倾角信息可以通过数据转换后得到。
由图7所示,该光电测量***中水平仪的Xi轴和Yi轴在水平方向相互正交,Zi轴指向天顶。相机的Xc轴和Yc轴分别与图像平面的x轴和y轴平行,Zc轴与光轴平行。因此,公式(18)的一个可能的初值为:
2、相机内参矩阵标定
求解公式(18)的过程中,需要已知相机的内参矩阵K。本发明采用张正友相机参数标定方法对相机内参矩阵进行K标定。标定过程中使用的棋盘格如图8所示。标定的内参矩阵K为:
3、实验数据测量
改变光电测量***的角度,确保视场中有显著的铅垂线,拍摄多张图像Ii(i=1,2,...,n),并记录对应的水平仪倾角数据(θi,φi),i=1,2,...,n。表2给出了12对水平仪倾角数据。
表2水平仪倾角数据(°)
采用Hough直线检测算法检测拍摄图像中的铅垂线,排除水平线或者长度小于200像素的线段。图9是一张拍摄图像中检测到的场景中的9条满足要求的铅垂线。表3给出了每条直线段两端点的对应坐标。
表3直线段两端点的坐标
4、水平仪装配误差标定
采用公式(18),得到水平仪装配误差矩阵:
Claims (1)
1.一种基于铅垂线的水平仪装配误差标定方法,其特征在于包括以下步骤:
步骤一:实验***搭建;将水平仪与相机固定在实验平台上,组成稳定的固连光电测量***;
步骤二:拍摄图像;改变光电测量***的角度,进行标定图像采集Ii,i=1,2,...,n,Ii为拍摄得到的每一帧图像,在采集过程中,确保视场中存在清晰的铅垂线,同时记录对应的水平仪倾角数据(θi,φi),i=1,2,...,n,θi表示水平仪x轴正方向与水平面的倾角,φi表示水平仪y轴正方向与水平面的倾角;
步骤四:建立求解水平仪装配误差的优化方程,求解水平仪装配误差Ric;令
并根据“场景中铅垂线在水平状态下拍摄的相机图像平面上应为竖直线”这一原理,得到
X1Y2-X2Y1=0 (3)
式(2)中,Ri(θ,φ)是水平仪倾角数据矩阵,K是相机内参矩阵,(x1,y1)和(x2,y2)是图像中检测到直线上的点坐标;
采用最小残差平方和方法,建立求解水平仪装配误差的优化方程如公式(1)所示,
式(1)中,Ric是光电测量***中需要标定的水平仪装配误差矩阵,I为一个3×3的单位矩阵,T表示矩阵的转置;
使用如公式(1)所示的优化方程计算水平仪装配误差矩阵Ric,从而实现水平仪装配误差的标定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711473507.9A CN109990801B (zh) | 2017-12-29 | 2017-12-29 | 基于铅垂线的水平仪装配误差标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711473507.9A CN109990801B (zh) | 2017-12-29 | 2017-12-29 | 基于铅垂线的水平仪装配误差标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109990801A CN109990801A (zh) | 2019-07-09 |
CN109990801B true CN109990801B (zh) | 2023-04-07 |
Family
ID=67109424
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711473507.9A Active CN109990801B (zh) | 2017-12-29 | 2017-12-29 | 基于铅垂线的水平仪装配误差标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109990801B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111678538B (zh) * | 2020-07-29 | 2023-06-09 | 中国电子科技集团公司第二十六研究所 | 一种基于速度匹配的动态水平仪误差补偿方法 |
CN112729109B (zh) * | 2020-12-21 | 2022-12-30 | 福建汇川物联网技术科技股份有限公司 | 一种点云数据的校正方法及装置 |
CN113776556B (zh) * | 2021-05-30 | 2024-05-07 | 南京理工大学 | 基于数据融合的陀螺仪与相机相对位置矩阵标定方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011158363A (ja) * | 2010-02-01 | 2011-08-18 | Hamamatsu Metrix Kk | Pga実装基板の半田付け検査装置 |
JP5545737B2 (ja) * | 2010-08-03 | 2014-07-09 | 富士機械製造株式会社 | 部品実装機及び画像処理方法 |
CN106803273B (zh) * | 2017-01-17 | 2019-11-22 | 湖南优象科技有限公司 | 一种全景摄像机标定方法 |
-
2017
- 2017-12-29 CN CN201711473507.9A patent/CN109990801B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109990801A (zh) | 2019-07-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110057295B (zh) | 一种免像控的单目视觉平面距离测量方法 | |
CN110296691B (zh) | 融合imu标定的双目立体视觉测量方法与*** | |
CN101858755B (zh) | 一种星敏感器的标定方法 | |
Zhang et al. | A robust and rapid camera calibration method by one captured image | |
EP1378790A2 (en) | Method and device for correcting lens aberrations in a stereo camera system with zoom | |
CN111220130B (zh) | 可对空间任意位置的物体测量的聚焦测量方法及终端 | |
CN106197292B (zh) | 一种建筑物位移监测方法 | |
CN108648242B (zh) | 基于激光测距仪辅助无公共视场的两相机标定方法及装置 | |
CN109990801B (zh) | 基于铅垂线的水平仪装配误差标定方法 | |
CN109887041B (zh) | 一种机械臂控制数字相机摄影中心位置和姿态的方法 | |
Feng et al. | Inertial measurement unit aided extrinsic parameters calibration for stereo vision systems | |
CN112229323B (zh) | 基于手机单目视觉的棋盘格合作目标的六自由度测量方法及其应用 | |
CN110398208A (zh) | 基于摄影全站仪***的大数据变形监测方法 | |
CN113870366B (zh) | 基于位姿传感器的三维扫描***的标定方法及其标定*** | |
CN113251953B (zh) | 一种基于立体偏折技术的镜面夹角测量装置和方法 | |
CN111220118B (zh) | 基于视觉惯性导航***的激光测距仪及测距方法 | |
CN115290008A (zh) | 一种影像测量平行光管的角度标定算法 | |
CN105809685A (zh) | 一种基于单幅同心圆图像的摄像机定标方法 | |
CN112729109B (zh) | 一种点云数据的校正方法及装置 | |
Oniga et al. | Metric and Non-Metric Cameras Calibration for the Improvement of Real-Time Monitoring Process Results. | |
CN104567812A (zh) | 空间位置测量方法及装置 | |
CN111754584A (zh) | 一种远距离大视场相机参数标定***和方法 | |
Sužiedelyte‐Visockiene et al. | Influence of digital camera errors on the photogrammetric image processing | |
CN112927299A (zh) | 标定方法、装置及电子设备 | |
JP2006330772A (ja) | 撮影画像における歪曲収差補正方法 |
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 |