CN112068108A - 一种基于全站仪的激光雷达外部参数标定方法 - Google Patents
一种基于全站仪的激光雷达外部参数标定方法 Download PDFInfo
- Publication number
- CN112068108A CN112068108A CN202010803513.1A CN202010803513A CN112068108A CN 112068108 A CN112068108 A CN 112068108A CN 202010803513 A CN202010803513 A CN 202010803513A CN 112068108 A CN112068108 A CN 112068108A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- total station
- vehicle body
- laser radar
- reference object
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 230000014509 gene expression Effects 0.000 claims abstract description 22
- 238000006243 chemical reaction Methods 0.000 claims abstract description 21
- 230000009286 beneficial effect Effects 0.000 abstract description 2
- 238000011900 installation process Methods 0.000 description 2
- 239000011087 paperboard Substances 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 239000000758 substrate Substances 0.000 description 1
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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/497—Means for monitoring or calibrating
-
- 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
-
- 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/15—Correlation function computation including computation of convolution operations
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Computational Mathematics (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Computing Systems (AREA)
- Operations Research (AREA)
- Computer Networks & Wireless Communication (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明公开了一种基于全站仪的激光雷达外部参数标定方法。本发明包括以下步骤:(1)全站仪扫描车体,确定车体坐标系与全站仪坐标系的转换关系;(2)全站仪扫描参考物,确定参考物在全站仪坐标系下的表达式,进一步求解参考物在车体坐标系下的方程表达式;(3)使用全站仪扫描激光雷达中心点在全站仪坐标系下的坐标,并根据步骤1的结果,转换到车体坐标系中;(4)激光雷达扫描参考物,确定参考物在激光雷达坐标系下的方程表达式;(5)根据参考物在车体坐标系、激光雷达坐标系下的方程表达式,求解车体坐标系与激光雷达坐标系的转换关系。本发明的有益效果:通过本发明可以在全站仪的辅助下,实现激光雷达坐标系与车体坐标系的统一。
Description
技术领域
本发明涉及一种基于全站仪的激光雷达外部参数标定方法,属于机器人自主导航技术领域。
背景技术
二维激光雷达不依赖于外界光照条件,是一种主动式探测传感器,且具备高精度的测距信息,是移动机器人常用的导航传感器。全站仪是一种集光、机、电为一体的高技术测量仪器,它通过提前完成设置好的基站,完成坐标系的建立,通过测量棱镜在坐标系的坐标和角度,求解出其坐标。
在实际的安装过程中激光雷达坐标系和车体坐标系下并不重合,因此才需要采取合适的方式将激光雷达坐标系与车体坐标系统一。
目前,研究比较多的是激光雷达与相机以及相机与载体的联合标定,而使用全站仪作为辅助对激光雷达与车体进行标定则鲜有人涉及到。
发明内容
本发明所要解决的技术问题是:提供一种基于全站仪的激光雷达外部参数标定方法,以解决安装过程中激光雷达坐标系与车体坐标系的不统一的问题。
本发明为解决上述技术问题采用以下技术方案:
一种基于全站仪的激光雷达外部参数标定方法,包括如下步骤:
进一步地,所述步骤1的具体过程如下:
使用全站仪测量车体中心,得到车体中心在全站仪坐标系下的坐标设车体中心点为车体坐标系原点,车体右方、前方、上方分别设为x轴、y轴、z轴,使用全站仪扫描车体与x轴平行的一条直线上距离较远的两点在全站仪坐标系下的坐标所以AGV小车在全站仪系下的航向为
由此可以得到车体坐标系和全站仪坐标系的转换关系。
进一步地,所述步骤2的具体过程如下:
选取具有平面结构的物体为参考物(如墙、纸板等)。
步骤:2.1使用全站仪扫描参考物,将全站仪扫描出的点投影到水平面上。
记Sw(k)为k时刻参考物的点云数据,通过最小二乘法对Sw(k)点云信息进行直线拟合,其目标函数为LW:aWxE+bWyE-1=0。
步骤2.2根据步骤1求出的车体坐标系和全站仪坐标系的转换关系,可以求出参考物在车体坐标系下的直线方程:
其中,
进一步地,所述步骤3的具体过程如下:
进一步地,所述步骤4的具体过程如下:
步骤4.1激光雷达扫描参考物,记Sm(k)为k时刻激光雷达的点云数据,将Sm(k)中的点云信息由极坐标系转换为直角坐标系。
步骤4.2对Sm(k)中的点云信息进行直线拟合,可以得到参考物在激光雷达坐标系下的直线方程,
具体过程如下:
由此可以得到参考物在激光雷达坐标系下的直线方程:
进一步地,所述步骤5的具体过程如下:
根据步骤2得到的参考物在车体坐标系下的直线方程表达式、步骤3中得到的激光雷达中心点在车体坐标系中的坐标和步骤4得到的参考物在激光雷达坐标系下的直线方程表达式,求解车体坐标系与激光雷达坐标系的转换关系。
设激光雷达坐标系和车体坐标系的坐标转换方程如下式所示:
式中,xC、yC和xL、yL分别是车体坐标系和激光雷达坐标系下的坐标,θ是两个坐标系之间的夹角。则
其中θ'为θ或者θ±π。
所以,
本方法的有益效果为:通过本发明可以在全站仪的辅助下,实现激光雷达坐标系与车体坐标系的统一,克服传统激光雷达无法快速应用于车体导航的难点。
附图说明
图1为本发明的流程图。
图2为本发明的关系图。
具体实施方式
下面详细描述本发明的实施方式,所述实施方式的示例在附图中示出。下面通过参考附图描述的实施方式是示例性的,仅用于解释本发明,而不能解释为对本发明的限制。
本发明为解决上述技术问题采用以下技术方案:
一种基于全站仪的激光雷达外部参数标定方法,流程图如图1所示,包括如下步骤:
步骤1,将全站仪、车体及参考物体如图2所示摆放,全站仪扫描车体,确定车体坐标系与全站仪坐标系的转换关系;
使用全站仪测量车体中心,得到车体中心在全站仪坐标系下的坐标设车体中心点为车体坐标系原点,车体右方、前方、上方分别设为x轴、y轴、z轴,使用全站仪扫描车体与x轴平行的一条直线上距离较远的两点在全站仪坐标系下的坐标所以AGV小车在全站仪系下的航向为
由此可以得到车体坐标系和全站仪坐标系的转换关系。
步骤2,全站仪扫描参考物,确定参考物在全站仪坐标系下的方程表达式,进一步求解参考物在车体坐标系下的方程表达式;
选取具有平面结构的物体为参考物(如墙、纸板等)。
步骤2.1使用全站仪扫描参考物,将全站仪扫描出的点投影到水平面上。
记Sw(k)为k时刻参考物的点云数据,通过最小二乘法对Sw(k)点云信息进行直线拟合,其目标函数为LW:aWxE+bWyE-1=0。
步骤2.2根据步骤1求出的车体坐标系和全站仪坐标系的转换关系,可以求出参考物在车体坐标系下的直线方程:
其中,
步骤3,使用全站仪扫描激光雷达中心点在全站仪坐标系下的坐标,并根据步骤1的结果,将其转换到车体坐标系中;
步骤4,激光雷达扫描参考物,确定参考物在激光雷达坐标系下的方程表达式;
步骤4.1激光雷达扫描参考物,记Sm(k)为k时刻激光雷达的点云数据,将Sm(k)中的点云信息由极坐标系转换为直角坐标系。
步骤4.2对Sm(k)中的点云信息进行直线拟合,可以得到参考物在激光雷达坐标系下的直线方程,
具体过程如下:
由此可以得到参考物在激光雷达坐标系下的直线方程:
步骤5,根据参考物在车体坐标系、激光雷达坐标系下的方程表达式,求解车体坐标系与激光雷达坐标系的转换关系;
根据步骤2得到的参考物在车体坐标系下的直线方程表达式、步骤3中得到的激光雷达中心点在车体坐标系中的坐标和步骤4得到的参考物在激光雷达坐标系下的直线方程表达式,求解车体坐标系与激光雷达坐标系的转换关系。
设激光雷达坐标系和车体坐标系的坐标转换方程如下式所示:
式中,xC、yC和xL、yL分别是车体坐标系和激光雷达坐标系下的坐标,θ是两个坐标系之间的夹角。则
其中θ'为θ或者θ±π。
所以:
Claims (6)
1.一种基于全站仪的激光雷达外部参数标定方法,其特征在于,包括如下步骤:
5.根据权利要求1所述一种基于全站仪的激光雷达外部参数标定方法,其特征在于,所述步骤4的具体过程如下:
步骤4.1:激光雷达扫描参考物,记Sm(k)为k时刻激光雷达的点云数据,将Sm(k)中的点云信息由极坐标系转换为直角坐标系;
步骤4.2对Sm(k)中的点云信息进行直线拟合,得到参考物在激光雷达坐标系下的直线方程;
具体过程如下:
由此得到参考物在激光雷达坐标系下的直线方程:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010803513.1A CN112068108A (zh) | 2020-08-11 | 2020-08-11 | 一种基于全站仪的激光雷达外部参数标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010803513.1A CN112068108A (zh) | 2020-08-11 | 2020-08-11 | 一种基于全站仪的激光雷达外部参数标定方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112068108A true CN112068108A (zh) | 2020-12-11 |
Family
ID=73661138
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010803513.1A Pending CN112068108A (zh) | 2020-08-11 | 2020-08-11 | 一种基于全站仪的激光雷达外部参数标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112068108A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113188569A (zh) * | 2021-04-07 | 2021-07-30 | 东软睿驰汽车技术(沈阳)有限公司 | 车辆与激光雷达的坐标系标定方法、设备及存储介质 |
CN114047487A (zh) * | 2021-11-05 | 2022-02-15 | 深圳市镭神智能系统有限公司 | 雷达和车体的外参标定方法、装置、电子设备和存储介质 |
WO2022160879A1 (zh) * | 2021-01-26 | 2022-08-04 | 华为技术有限公司 | 一种转换参数的确定方法和装置 |
CN114935747A (zh) * | 2022-05-02 | 2022-08-23 | 苏州一径科技有限公司 | 一种激光雷达的标定方法、装置、设备及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106643805A (zh) * | 2016-12-30 | 2017-05-10 | 上海交通大学 | 激光定位传感器在agv小车中位置标定方法 |
CN107782240A (zh) * | 2017-09-27 | 2018-03-09 | 首都师范大学 | 一种二维激光扫描仪标定方法、系统及装置 |
CN108278968A (zh) * | 2018-01-17 | 2018-07-13 | 北京建筑大学 | 一种车载扫描系统控制点检校方法 |
CN109901139A (zh) * | 2018-12-28 | 2019-06-18 | 文远知行有限公司 | 激光雷达标定方法、装置、设备和存储介质 |
US20190235062A1 (en) * | 2017-08-23 | 2019-08-01 | Tencent Technology (Shenzhen) Company Limited | Method, device, and storage medium for laser scanning device calibration |
CN110142805A (zh) * | 2019-05-22 | 2019-08-20 | 武汉爱速达机器人科技有限公司 | 一种基于激光雷达的机器人末端校准方法 |
-
2020
- 2020-08-11 CN CN202010803513.1A patent/CN112068108A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106643805A (zh) * | 2016-12-30 | 2017-05-10 | 上海交通大学 | 激光定位传感器在agv小车中位置标定方法 |
US20190235062A1 (en) * | 2017-08-23 | 2019-08-01 | Tencent Technology (Shenzhen) Company Limited | Method, device, and storage medium for laser scanning device calibration |
CN107782240A (zh) * | 2017-09-27 | 2018-03-09 | 首都师范大学 | 一种二维激光扫描仪标定方法、系统及装置 |
CN108278968A (zh) * | 2018-01-17 | 2018-07-13 | 北京建筑大学 | 一种车载扫描系统控制点检校方法 |
CN109901139A (zh) * | 2018-12-28 | 2019-06-18 | 文远知行有限公司 | 激光雷达标定方法、装置、设备和存储介质 |
CN110142805A (zh) * | 2019-05-22 | 2019-08-20 | 武汉爱速达机器人科技有限公司 | 一种基于激光雷达的机器人末端校准方法 |
Non-Patent Citations (2)
Title |
---|
康永伟等: "车载激光扫描仪外参数标定方法研究", 《红外与激光工程》, pages 249 - 253 * |
韦邦国等: "遗传算法在双激光雷达位姿标定中的应用", 《计量与测试技术》, pages 91 - 95 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2022160879A1 (zh) * | 2021-01-26 | 2022-08-04 | 华为技术有限公司 | 一种转换参数的确定方法和装置 |
CN113188569A (zh) * | 2021-04-07 | 2021-07-30 | 东软睿驰汽车技术(沈阳)有限公司 | 车辆与激光雷达的坐标系标定方法、设备及存储介质 |
CN114047487A (zh) * | 2021-11-05 | 2022-02-15 | 深圳市镭神智能系统有限公司 | 雷达和车体的外参标定方法、装置、电子设备和存储介质 |
CN114047487B (zh) * | 2021-11-05 | 2022-07-26 | 深圳市镭神智能系统有限公司 | 雷达和车体的外参标定方法、装置、电子设备和存储介质 |
CN114935747A (zh) * | 2022-05-02 | 2022-08-23 | 苏州一径科技有限公司 | 一种激光雷达的标定方法、装置、设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112068108A (zh) | 一种基于全站仪的激光雷达外部参数标定方法 | |
CN111505606B (zh) | 多相机与激光雷达系统相对位姿检校方法及装置 | |
CN108571971B (zh) | 一种agv视觉定位系统及方法 | |
CN102825602B (zh) | 一种基于psd的工业机器人自标定方法及装置 | |
CN111060898B (zh) | 场端多线束激光雷达内参标定方法 | |
CN111561868A (zh) | 一种利用光学跟踪结构光扫描器实现天线型面非接触测量的方法 | |
CN111913169B (zh) | 激光雷达内参、点云数据的修正方法、设备及存储介质 | |
CN103837084A (zh) | 基于激光光斑成像技术的三向位移量测方法 | |
CN112017248B (zh) | 一种基于点线特征的2d激光雷达相机多帧单步标定方法 | |
CN104007444A (zh) | 一种基于中心投影的地面激光雷达反射强度图像的生成方法 | |
Gao et al. | A method of spatial calibration for camera and radar | |
CN113028990A (zh) | 一种基于加权最小二乘的激光跟踪姿态测量系统及方法 | |
CN110370287B (zh) | 基于视觉引导的地铁列检机器人路径规划系统及方法 | |
CN111208497A (zh) | 一种机载激光雷达系统平差处理方法 | |
CN114296097A (zh) | 基于GNSS和LiDAR的SLAM导航方法及系统 | |
CN118196324A (zh) | 一种点云过滤融合建图方法、装置及计算机存储介质 | |
CN111142117A (zh) | 融合折角板及占据栅格的混合导航地图构建方法及系统 | |
CN107388974B (zh) | 光电式双向位移量测方法 | |
CN112797893A (zh) | 一种用于远距离线缆位置参数的测量方法 | |
CN111811419A (zh) | 一种基于激光的桥梁挠度检测系统及方法 | |
CN113109829B (zh) | 一种同步扫描交会测量敏感器的标定方法 | |
CN113240751B (zh) | 一种机器人末端相机的标定方法 | |
Wang et al. | Distance measurement using single non-metric CCD camera | |
Wu et al. | A novel precise guiding method for visual guiding theodolite measurement in volume space | |
JP2567923B2 (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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20201211 |
|
WD01 | Invention patent application deemed withdrawn after publication |