CN110764117A - 基于全站仪的检测机器人天线与传感器相对位置标定方法 - Google Patents
基于全站仪的检测机器人天线与传感器相对位置标定方法 Download PDFInfo
- Publication number
- CN110764117A CN110764117A CN201911051446.6A CN201911051446A CN110764117A CN 110764117 A CN110764117 A CN 110764117A CN 201911051446 A CN201911051446 A CN 201911051446A CN 110764117 A CN110764117 A CN 110764117A
- Authority
- CN
- China
- Prior art keywords
- sensor
- total station
- calculating
- follows
- antenna
- 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.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/23—Testing, monitoring, correcting or calibrating of receiver elements
- G01S19/235—Calibration of receiver components
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C15/00—Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D18/00—Testing or calibrating apparatus or arrangements provided for in groups G01D1/00 - G01D15/00
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
- G01S7/40—Means for monitoring or calibrating
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了基于全站仪的检测机器人天线与传感器相对位置标定方法,包括如下步骤:步骤一,以全站仪为原点建立水平的直角坐标系,将道面检测机器人静止放置在直角坐标系中,调整道面检测机器人保持水平;步骤二,通过全站仪测得道面检测机器人上两个GPS天线、第一传感器左右两端以及第二传感器中心的水平投影坐标;步骤三,计算两个GPS天线中心在水平面的投影点的连线中点的坐标;步骤四,计算CA到PC的距离;计算PC到PR的距离;计算CA到PR的距离;步骤五,GPS天线与第二传感器中心和第一传感器中心的相对位置计算。本发明能在出厂时对道面检测机器人上的GPS天线与各种传感器的相对位置进行标定。
Description
技术领域
本发明涉及道面检测机器人技术领域,尤其是基于全站仪的检测机器人天线与传感器相对位置标定方法。
背景技术
道面检测机器人依靠差分GPS定位,机器人上携带2d工业相机、3d相机、探地雷达等多种传感器。道面检测机器人本身的位置和姿态感知通过安装在道面检测机器人上的两个GPS天线计算。根据两个GPS天线的GPS坐标可以计算两根天线连线的朝向。两个GPS天线在道面检测机器人上安装的相对位置已知,根据这个对应关系就可以计算出道面检测机器人中心的坐标和航向角。
同理,根据2d相机、3d相机、探地雷达等机载传感器与两个GPS天线的相对位置,就可以计算出道面检测机器人运行时,2d相机、3d相机、探地雷达等机载传感器的坐标。有了这些信息,就可以在拍照和探测时记录相片和雷达数据对应的实际位置。
然而,实际生产和应用中,由于加工和安装精度难以保证,实际上这些传感器与天线在道面检测机器人上的相对位置和图纸的理想值存在偏差,而且这些偏差对每台道面检测机器人来说都不一样,因此,在出厂时,有必要对道面检测机器人上GPS天线以及各种传感器的相对位置进行标定。
发明内容
针对上述不足之处,本发明提供了基于全站仪的检测机器人天线与传感器相对位置标定方法,能在出厂时对道面检测机器人上的GPS天线与各种传感器的相对位置进行标定。
为了实现上述目的,本发明采用的技术方案如下:
基于全站仪的检测机器人天线与传感器相对位置标定方法,包括如下步骤:
步骤一,以全站仪为原点建立水平的直角坐标系,将道面检测机器人静止放置在直角坐标系中,调整道面检测机器人保持水平;
步骤四,计算CA到PC的距离,记为L1;计算PC到PR的距离,记为L2;计算CA到PR的距离,记为L3;
步骤五,GPS天线与第二传感器中心和第一传感器中心的相对位置计算,包括:
(a)计算CA距离PC在道面检测机器人本体坐标系的偏移,分别记为△CX和△CY,计算公式为:其中,θC为CA与PC连线和PL与PR连线的夹角;
(b)计算GC到PC的距离,记为L4;计算GC到PR的距离,记为L5;
(c)计算第一传感器左右两端水平投影点GL和GR连线的中点GC在道面检测机器人本体坐标系中距离PC的偏移,分别记为△GX和△GY,计算公式为:其中,第一传感器左右两端水平投影的中点坐标记为记为θG为GC与PC的连线和PL与PR连线的夹角;
(d)计算第一传感器与GPS天线连线水平方向的夹角,记为αG,计算方法如下:
至此,GPS天线与第二传感器和第一传感器的相对位置标定完毕。
更进一步的,L1的计算公式为:
与现有技术相比,本发明具有以下有益效果:
本发明能在出厂时对道面检测机器人上的GPS天线与各种传感器的相对位置进行标定,消除加工和安装精度不足带来的传感器实际与天线在道面检测机器人上的相对位置和图纸的理想值的偏差。使得采集的传感器信息获得更为精确地位置标签修正,方便使用时根据传感器信息上反映的道面缺陷,准确定位到缺陷的具***置。
附图说明
图1为本发明的流程示意图。
图2为本发明的实施例以全站仪为原点建立水平的直角坐标系示意图。
图3为本发明的实施例的雷达与GPS天线连线水平方向的夹角αG。
具体实施方式
下面结合附图和实施例对本发明作进一步说明,本发明的实施方式包括但不限于下列实施例。
实施例:
如图1至3所示,本实施例以道面检测机器人的雷达和2d相机的位置标定为例,基于全站仪的检测机器人天线与传感器相对位置标定方法,包括如下步骤:
步骤一,以全站仪为原点建立水平的直角坐标系,将道面检测机器人静止放置在直角坐标系中,调整道面检测机器人保持水平;
步骤四,计算CA到PC的距离,记为L1;计算PC到PR的距离,记为L2;计算CA到PR的距离,记为L3;
步骤五,GPS天线与相机中心和雷达中心的相对位置计算,包括:
(b)计算GC到PC的距离,记为L4;计算GC到PR的距离,记为L5;
(c)计算雷达左右两端水平投影点GL和GR连线的中点GC在道面检测机器人本体坐标系中距离PC的偏移,分别记为△GX和△GY,计算公式为:其中,雷达左右两端水平投影的中点坐标记为记为θG为GC与PC的连线和PL与PR连线的夹角;
(d)计算雷达与GPS天线连线水平方向的夹角,记为αG,计算方法如下:
至此,GPS天线与相机和雷达的相对位置标定完毕。
上述实施例仅为本发明的优选实施例,并非对本发明保护范围的限制,但凡采用本发明的设计原理,以及在此基础上进行非创造性劳动而做出的变化,均应属于本发明的保护范围之内。
Claims (10)
1.基于全站仪的检测机器人天线与传感器相对位置标定方法,其特征在于,包括如下步骤:
步骤一,以全站仪为原点建立水平的直角坐标系,将道面检测机器人静止放置在直角坐标系中,调整道面检测机器人保持水平;
步骤二,通过全站仪测得道面检测机器人上两个GPS天线、第一传感器左右两端以及第二传感器中心的水平投影坐标,分别记为PL(xPL,yPL)、PR(xPR,yPR)、GL(xGL,yGL)、GR(xGR,yGR)和CA(xCA,yCA);
步骤三,计算两个GPS天线中心在水平面的投影点的连线中点的坐标,记为PC(xPC,yPC);
步骤四,计算CA到PC的距离,记为L1;计算PC到PR的距离,记为L2;计算CA到PR的距离,记为L3;
步骤五,GPS天线与第二传感器中心和第一传感器中心的相对位置计算,包括:
(b)计算GC到PC的距离,记为L4;计算GC到PR的距离,记为L5;
(c)计算第一传感器左右两端水平投影点GL和GR连线的中点GC在道面检测机器人本体坐标系中距离PC的偏移,分别记为△GX和△GY,计算公式为:其中,第一传感器左右两端水平投影的中点坐标记为记为GC(xGC,yGC),θG为GC与PC的连线和PL与PR连线的夹角;
(d)计算第一传感器与GPS天线连线水平方向的夹角,记为αG,计算方法如下:
至此,GPS天线与第二传感器和第一传感器的相对位置标定完毕。
4.根据权利要求3所述的基于全站仪的检测机器人天线与传感器相对位置标定方法,其特征在于,L1的计算公式为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911051446.6A CN110764117B (zh) | 2019-10-31 | 2019-10-31 | 基于全站仪的检测机器人天线与传感器相对位置标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911051446.6A CN110764117B (zh) | 2019-10-31 | 2019-10-31 | 基于全站仪的检测机器人天线与传感器相对位置标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110764117A true CN110764117A (zh) | 2020-02-07 |
CN110764117B CN110764117B (zh) | 2022-10-11 |
Family
ID=69335320
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911051446.6A Active CN110764117B (zh) | 2019-10-31 | 2019-10-31 | 基于全站仪的检测机器人天线与传感器相对位置标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110764117B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111487585A (zh) * | 2020-04-29 | 2020-08-04 | 华中科技大学 | 一种移动机器人rfid定位***的天线位置标定方法 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1082638A (ja) * | 1996-05-27 | 1998-03-31 | Nikon Corp | Gps測量機 |
CN101101332A (zh) * | 2007-06-05 | 2008-01-09 | 长春理工大学 | Ccd激光经纬仪动态雷达标校方法 |
JP2009294128A (ja) * | 2008-06-06 | 2009-12-17 | Visuatool Inc | 3次元計測システム、計測端末、3次元形状の計測方法、およびトータルステーション |
CN101960256A (zh) * | 2008-02-29 | 2011-01-26 | 特林布尔公司 | 测量仪器的自动校准 |
CN103363949A (zh) * | 2013-07-19 | 2013-10-23 | 北京卫星制造厂 | 一种卫星天线混合测量分析的方法 |
CN103438906A (zh) * | 2013-09-10 | 2013-12-11 | 上海海事大学 | 适用于机器人导航的视觉与卫星定位传感器联合校准方法 |
CN105424059A (zh) * | 2015-11-06 | 2016-03-23 | 西北工业大学 | 宽基线近红外相机位姿估计方法 |
CN109341701A (zh) * | 2018-12-06 | 2019-02-15 | 上海圭目机器人有限公司 | 基于激光跟踪全站仪的地面机器人航向角实时获取方法 |
CN110045340A (zh) * | 2019-02-28 | 2019-07-23 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | 平面相控阵天线中信标天线的坐标测算方法 |
CN110045339A (zh) * | 2019-02-28 | 2019-07-23 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | 球面相控阵天线的标校测算方法 |
CN110108984A (zh) * | 2019-05-24 | 2019-08-09 | 中国南方电网有限责任公司超高压输电公司检修试验中心 | 电力巡线激光雷达***多传感器的空间关系同步方法 |
-
2019
- 2019-10-31 CN CN201911051446.6A patent/CN110764117B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1082638A (ja) * | 1996-05-27 | 1998-03-31 | Nikon Corp | Gps測量機 |
CN101101332A (zh) * | 2007-06-05 | 2008-01-09 | 长春理工大学 | Ccd激光经纬仪动态雷达标校方法 |
CN101960256A (zh) * | 2008-02-29 | 2011-01-26 | 特林布尔公司 | 测量仪器的自动校准 |
JP2009294128A (ja) * | 2008-06-06 | 2009-12-17 | Visuatool Inc | 3次元計測システム、計測端末、3次元形状の計測方法、およびトータルステーション |
CN103363949A (zh) * | 2013-07-19 | 2013-10-23 | 北京卫星制造厂 | 一种卫星天线混合测量分析的方法 |
CN103438906A (zh) * | 2013-09-10 | 2013-12-11 | 上海海事大学 | 适用于机器人导航的视觉与卫星定位传感器联合校准方法 |
CN105424059A (zh) * | 2015-11-06 | 2016-03-23 | 西北工业大学 | 宽基线近红外相机位姿估计方法 |
CN109341701A (zh) * | 2018-12-06 | 2019-02-15 | 上海圭目机器人有限公司 | 基于激光跟踪全站仪的地面机器人航向角实时获取方法 |
CN110045340A (zh) * | 2019-02-28 | 2019-07-23 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | 平面相控阵天线中信标天线的坐标测算方法 |
CN110045339A (zh) * | 2019-02-28 | 2019-07-23 | 西南电子技术研究所(中国电子科技集团公司第十研究所) | 球面相控阵天线的标校测算方法 |
CN110108984A (zh) * | 2019-05-24 | 2019-08-09 | 中国南方电网有限责任公司超高压输电公司检修试验中心 | 电力巡线激光雷达***多传感器的空间关系同步方法 |
Non-Patent Citations (1)
Title |
---|
王海涛,等: "《全站仪在设备标校中的应用》", 《仪器仪表用户》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111487585A (zh) * | 2020-04-29 | 2020-08-04 | 华中科技大学 | 一种移动机器人rfid定位***的天线位置标定方法 |
CN111487585B (zh) * | 2020-04-29 | 2022-03-15 | 华中科技大学 | 一种移动机器人rfid定位***的天线位置标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110764117B (zh) | 2022-10-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105588563B (zh) | 一种智能驾驶中双目相机与惯性导航联合标定方法 | |
US8452568B2 (en) | Method for calibrating cameras installed on vehicle | |
CN104428686B (zh) | 用于获得车辆位置的方法和车辆 | |
CN111380573B (zh) | 用于校准运动的对象传感器的取向的方法 | |
CN101216937B (zh) | 港口运动集装箱定位***的参数标定方法 | |
CN112880642B (zh) | 测距***和测距方法 | |
CN110488838B (zh) | 一种室内自主导航机器人精确重复定位方法 | |
CN105573310B (zh) | 一种煤矿巷道机器人定位与环境建模方法 | |
CN101629822B (zh) | 振动环境中的多相机动态摄影测量方法 | |
CN104816307A (zh) | 工业机器人精准制孔的四点法向调平方法 | |
CN109887041B (zh) | 一种机械臂控制数字相机摄影中心位置和姿态的方法 | |
CN106500619A (zh) | 基于视觉测量的相机内部图像传感器安装误差分离方法 | |
CN113358135B (zh) | 一种用光电测量数据修正飞行器位置的方法 | |
CN113409396A (zh) | 一种adas单目相机的标定方法 | |
JP7504251B2 (ja) | 可搬型基準センサシステムを較正するための方法、可搬型基準センサシステム、および可搬型基準センサシステムの使用 | |
CN115235379A (zh) | 一种单目线激光三维视觉传感器参数在位标定装置及方法 | |
CN105066988A (zh) | 一种基于高精度磁导航传感器的磁条偏差角度的测量方法 | |
CN110764117B (zh) | 基于全站仪的检测机器人天线与传感器相对位置标定方法 | |
JP2007533963A (ja) | 物体の3d位置の非接触式光学的測定方法及び測定装置 | |
WO2023050567A1 (zh) | 一种基于毫米波车载雷达场景识别的航位修正方法 | |
CN109712198B (zh) | 一种高级驾驶辅助***的标定方法 | |
JP2007533963A5 (zh) | ||
CN108627103A (zh) | 一种零部件高度尺寸的2d激光测量方法 | |
CN109990801B (zh) | 基于铅垂线的水平仪装配误差标定方法 | |
CN112945266B (zh) | 激光导航机器人及其机器人的里程计校准方法 |
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 |