CN105717498B - 激光测距仪俯仰角测量与校正系统及方法 - Google Patents
激光测距仪俯仰角测量与校正系统及方法 Download PDFInfo
- Publication number
- CN105717498B CN105717498B CN201610080321.6A CN201610080321A CN105717498B CN 105717498 B CN105717498 B CN 105717498B CN 201610080321 A CN201610080321 A CN 201610080321A CN 105717498 B CN105717498 B CN 105717498B
- Authority
- CN
- China
- Prior art keywords
- laser
- firmware
- demarcation
- laser ranging
- ranging unit
- 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
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
- G01S7/4972—Alignment of sensor
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Measurement Of Optical Distance (AREA)
Abstract
本发明公开了一种激光测距仪俯仰角测量与校正系统及方法,所述系统包括第一标定固件、第二标定固件、数据处理单元、激光测距单元、载体装置和控制单元;第一标定固件用于固定载体装置的位置;第二标定固件用于使激光测距单元发出的激光产生反射;数据处理单元用于处理并计算激光测距单元传回的激光扫描点数据;激光测距单元用于发射并接收激光;控制单元用于控制激光测距单元的激光的发射与接收。系统的外部组件仅包括第一标定固件和第二标定固件,系统的制作和操作十分简单,应用本系统测量激光测距仪的俯仰角,通过标准统计学方法分析测量结果,具有成本低、操作简单、精度满足实用要求等优点。
Description
技术领域
本发明涉及一种激光测距仪俯仰角测量与校正系统。
背景技术
随着计算机和机器人技术的发展,移动机器人得到了快速发展和广泛应用,几乎渗透到了社会生活的各个领域。激光测距仪具有测距快、体积小、性能可靠等优点。近年来,随着其成本不断下调,被越来越广泛的应用于移动机器人的定位与导航。
在使用之前,激光测距仪需要与车体坐标进行标定,以便更好的用于定位导航。在具体使用过程中,需要使激光测距仪保持水平;需要测量激光测距仪的偏角;需要测量激光测距仪在车体坐标系中的位置,以便与其它传感器如摄像头、里程计等进行信息融合,如安装激光测距仪时,激光测距仪存在俯仰角与偏转角,会导致测量结果不准确,从而导致定位信息不准确。
发明内容
本发明的目的在于针对现有技术的不足,提供一种激光测距仪俯仰角测量与校正系统及方法。
本发明的目的是通过以下技术方案来实现的:一种激光测距仪俯仰角测量与校正系统,包括第一标定固件、第二标定固件、数据处理单元、激光测距单元、载体装置和控制单元;
所述第一标定固件用于固定载体装置的位置;
所述第二标定固件用于使激光测距单元发出的激光产生反射,包括第一标定板与第二标定板,所述第一标定板与第二标定板处于不同高度,且前后相距d0平行放置,d0>0;
所述数据处理单元用于处理并计算激光测距单元传回的激光扫描点数据;
所述激光测距单元用于发射并接收激光;
所述载体装置作为安装激光测距单元、控制单元和数据处理单元的载体;
所述控制单元用于控制激光测距单元的激光的发射与接收,并将激光测距单元传出的数据传递给数据处理单元进行数据的计算。
进一步地,所述第一标定固件为一平行第二标定固件的载体装置卡槽。
进一步地,所述第一标定板和第二标定板距离平面的高度可调。
一种激光测距仪俯仰角测量与校正的方法,包括以下步骤:
步骤S1,固定安装有激光测距单元的载体装置;
步骤S2,获取至少一次激光测距单元与第二标定固件的距离;
步骤S3,对比标准距离,判断俯仰角偏差是否符合标准;
步骤S4,调整激光测距单元校正俯仰角。
进一步地,所述激光测距单元安装距离符合l为第二标定板的宽度,d为激光测距单元距离第二标定固件中第二标定板的距离,θ0为俯仰角偏差。
进一步地,所述步骤S2中,所述距离通过直线检测模块拟合激光测距单元与第二标定固件之间激光扫描点形成的直线获取。
进一步地,所述拟合采用最小标准二乘算法,所述距离近似等于其中,xi、yi为激光测距单元坐标系下激光扫描点的坐标,m为激光扫描点个数。
进一步地,通过残差与设定阈值比较,判断是否存在直线。
进一步地,所述残差大小为 Eth为设定阈值;
本发明的有益效果是:本发明系统的外部组件仅仅包括第一标定固件和第二标定固件,而载体装置、激光测距单元、数据处理单元、控制单元是产品本身固有的装置,因此本系统的制作和操作都十分简单,应用本系统测量激光测距仪的俯仰角,通过标准统计学方法分析测量结果,具有成本低、操作简单、精度满足实用要求等优点。
附图说明
图1为本发明激光测距仪俯仰角测量与校正系统结构框图;
图2为第一标定固件的结构图,(a)为两个标定板正视图,(b)为两个标定板侧视图;
图3为本发明激光测距仪俯仰角测量与校正方法原理;
图中,第一标定固件1、第二标定固件2、第一标定板21、第二标定板22、数据处理单元3、激光测距单元4、载体装置5、控制单元6。
具体实施方式
下面结合附图和具体实施例对本发明作进一步详细说明。
激光测距仪俯仰角测量与校正系统用以校正安装有激光传感器的任何智能运动系统中激光传感器的位置是否与预期一致,图1根据本发明的原理构造的系统示意图,包括第一标定固件1、第二标定固件2、激光测距单元4、控制单元6、载体装置5和数据处理单元3;
所述载体装置5作为安装激光测距单元4、控制单元6和数据处理单元3的载体,可在控制单元6作用下在一平面内自由移动;
所述数据处理单元3用于处理并计算激光测距单元4传回的激光扫描点数据;
所述控制装置6用于控制激光测距单元4的激光的发射与接收,并将激光测距单元4传出的数据传递给数据处理单元3进行数据的计算;
所述第一标定固件1用于固定载体装置5,使载体装置5上安装的激光测距单元4正对第二标定固件2,具体实施例中,第一标定固件1为一平行第二标定固件2设置的载体装置卡槽;
如图2所示,所述第二标定固件2包括第一标定板21和第二标定板22,用于反射激光;所述第一标定板21和第二标定板22距离平面的高度可调,第一标定板21与第二标定板22前后相距d0平行放置,第一标定板21与第二标定板22的距离平面的高度h2、h1,且从平面视图方向,第一标定板21与第二标定板22之间没有缝隙,激光测距单元4对准第二标定板22中点,此处平行和垂直不需要特别精确,肉眼判断即可。
激光测距单元4发射并接收反射的激光,其安装在载体装置5高度与第二标定板22中线等高位置,激光发射端面向第二标定固件2,即本发明需要测定其俯仰角;
本发明提供的激光测距单元俯仰角角度测量与校正方法,包括以下步骤:
步骤S1:固定安装有激光测距单元4的载体装置5
所述载体装置5通过于第一标定固件1的卡槽固定,激光测距单元4发射激光的面朝向第二标定固件2,此时激光测距单元4可能与预期水平;
进一步地,激光测距单元4安装时可接受的俯仰角偏差范围为±θ0,则激光测距单元4与第二标定固件2中第二标定板22的距离需满足如下约束:
其中,l为第二标定板22的标准宽度,d为激光测距单元4距离第二标定固件2中第二标定板22的距离,如图2、图3所示,通常根据实际应用需要,取值如下,θ0=0.3度,d=5米,d0=0.2米。
步骤S2:获取至少一次激光测距单元4与第二标定固件2的距离;
具体地,所述距离通过数据处理单元3对激光测距单元4传回的激光扫描点相关数据计算获得;
所述激光测距单元4发射出的激光经被第二标定固件2反射后被激光测距单元4接收,激光测距单元4记录激光往返的时间,时间的一半与光速的乘积即为激光测距单元4与第二标定固件2之间的距离。
另一种实施方式为,激光测距单元4记录激光测距单元4与第二标定固件2之间激光扫描点坐标,数据处理单元3内包括直线检测模块,通过直线检测模块拟合激光测距单元4与第二标定固件2之间激光扫描点形成的直线获取距离,拟合采用标准最小二乘算法,即:
直线参数通过以下公式获得:
其中,xi、yi为激光测距单元4坐标系下激光扫描点的坐标;m为激光扫描点个数。
通过残差与设定阈值相比较,判断是否存在直线,其中,所述残差大小为 Eth为设定阈值;
当时,直线存在;第二标定固件2与激光测距单元4的距离近似用直线参数代替,具体实施时,激光扫描点大约有20个,即m=20。
步骤S3:对比标准距离,判断俯仰角偏差是否符合标准
具体地,如图3所示,标准距离为d,当直线检测模块检测到距离为d时,俯仰角偏差θ0符合要求;当检测到距离为d-d0或d+d0的直线或当没有检测到直线或检测到其它距离的直线时,俯仰角偏差θ0均不符合要求。
步骤S4:调整激光测距单元4校正俯仰角。
具体地,通过增加或减少激光测距单元4下的垫片,使俯仰角偏差θ0符合要求。
Claims (9)
1.一种激光测距仪俯仰角测量与校正系统,其特征在于,包括第一标定固件、第二标定固件、数据处理单元、激光测距单元、载体装置和控制单元;
所述第一标定固件用于固定载体装置的位置;
所述第二标定固件用于使激光测距单元发出的激光产生反射,包括第一标定板与第二标定板,所述第一标定板与第二标定板处于不同高度,且前后相距d0平行放置,d0>0;
所述数据处理单元用于处理并计算激光测距单元传回的激光扫描点数据;
所述激光测距单元用于发射并接收激光;
所述载体装置作为安装激光测距单元、控制单元和数据处理单元的载体;
所述控制单元用于控制激光测距单元的激光的发射与接收,并将激光测距单元传出的数据传递给数据处理单元进行数据的计算。
2.如权利要求1所述的系统,其特征在于,所述第一标定固件为一平行第二标定固件的载体装置卡槽。
3.如权利要求1所述的系统,其特征在于,所述第一标定板和第二标定板距离工作平面的高度可调。
4.一种利用权利要求1所述系统进行激光测距仪俯仰角测量与校正的方法,其特征在于,包括以下步骤:
步骤S1,固定安装有激光测距单元的载体装置;
步骤S2,获取至少一次激光测距单元与第二标定固件的距离;
步骤S3,对比标准距离,判断俯仰角偏差是否符合标准;
步骤S4,调整激光测距单元校正俯仰角。
5.如权利要求4所述的方法,其特征在于,所述激光测距单元安装距离符合l为第二标定板的宽度,d为激光测距单元距离第二标定固件中第二标定板的距离,θ0为俯仰角偏差。
6.如权利要求4所述的方法,其特征在于,所述步骤S2中,所述距离通过直线检测模块拟合激光测距单元与第二标定固件之间激光扫描点形成的直线获取。
7.如权利要求6所述的方法,其特征在于,所述拟合采用最小标准二乘算法,所述距离近似等于其中,xi、yi为激光测距单元坐标系下激光扫描点的坐标,m为激光扫描点个数。
8.如权利要求7所述的方法,其特征在于,通过残差与设定阈值比较,判断是否存在直线。
9.如权利要求8所述的方法,其特征在于,所述残差大小为 Eth为设定阈值;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610080321.6A CN105717498B (zh) | 2016-02-04 | 2016-02-04 | 激光测距仪俯仰角测量与校正系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610080321.6A CN105717498B (zh) | 2016-02-04 | 2016-02-04 | 激光测距仪俯仰角测量与校正系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105717498A CN105717498A (zh) | 2016-06-29 |
CN105717498B true CN105717498B (zh) | 2018-02-16 |
Family
ID=56155772
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610080321.6A Active CN105717498B (zh) | 2016-02-04 | 2016-02-04 | 激光测距仪俯仰角测量与校正系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105717498B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107272715B (zh) * | 2017-01-09 | 2020-05-01 | 江苏空神航空工业有限公司 | 一种基于四向角度校正的无人机及校正控制方法 |
CN106643640B (zh) * | 2017-01-09 | 2019-12-13 | 浙江力冠机械有限公司 | 一种机载角度校正装置及校正方法 |
CN107436606B (zh) * | 2017-01-09 | 2020-08-14 | 义乌市勘测设计研究院 | 一种基于三向角度校正的无人机及校正控制方法 |
CN107085434B (zh) * | 2017-01-09 | 2020-08-11 | 广西北部湾顺翔科技有限公司 | 一种基于双向角度校正的无人机及校正控制方法 |
CN106813683B (zh) * | 2017-01-09 | 2020-05-29 | 宿州青果知识产权服务有限公司 | 一种双向机载角度校正装置及校正方法 |
CN107193284B (zh) * | 2017-01-09 | 2020-07-14 | 舟山丽驰技术开发有限公司 | 一种基于角度校正的无人机及校正的控制方法 |
CN106813682B (zh) * | 2017-01-09 | 2020-05-15 | 宿州青果知识产权服务有限公司 | 一种四向机载角度校正装置及校正方法 |
CN106813684B (zh) * | 2017-01-09 | 2020-05-19 | 宿州青果知识产权服务有限公司 | 一种三向机载角度校正装置及校正方法 |
CN111624578B (zh) * | 2019-02-28 | 2023-08-15 | 深圳市速腾聚创科技有限公司 | 激光测距标定方法、装置、系统和计算机设备 |
CN112558044A (zh) * | 2020-11-26 | 2021-03-26 | 英博超算(南京)科技有限公司 | 一种车载激光雷达俯仰角自动矫正方法 |
CN112904320A (zh) * | 2021-05-07 | 2021-06-04 | 深圳阜时科技有限公司 | 光学模组测试方法和系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6864969B1 (en) * | 1999-06-07 | 2005-03-08 | DEUTSCHES ZENTRUM FüR LUFT-UND RAUMFAHRT E.V. | Calibration system for calibrating orientation parameters of digital optoelectronic sensors in a mobile carrier used for remote reconnaisance |
CN101882313A (zh) * | 2010-07-14 | 2010-11-10 | 中国人民解放军国防科学技术大学 | 单线激光雷达与ccd相机之间相互关系的标定方法 |
CN102636774A (zh) * | 2012-04-26 | 2012-08-15 | 天津大学 | 一种基于光电扫描与超声测距的全站式空间测量定位方法 |
CN102997845A (zh) * | 2012-12-06 | 2013-03-27 | 北京理工大学 | 货车车厢体积测量系统的校准方法 |
CN103547939A (zh) * | 2011-05-13 | 2014-01-29 | 赫克斯冈技术中心 | 用于具有扫描功能的装置的校准方法 |
CN105136058A (zh) * | 2015-05-14 | 2015-12-09 | 上海大学 | 激光传感三维测量系统的在线标定装置及其标定方法 |
-
2016
- 2016-02-04 CN CN201610080321.6A patent/CN105717498B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6864969B1 (en) * | 1999-06-07 | 2005-03-08 | DEUTSCHES ZENTRUM FüR LUFT-UND RAUMFAHRT E.V. | Calibration system for calibrating orientation parameters of digital optoelectronic sensors in a mobile carrier used for remote reconnaisance |
CN101882313A (zh) * | 2010-07-14 | 2010-11-10 | 中国人民解放军国防科学技术大学 | 单线激光雷达与ccd相机之间相互关系的标定方法 |
CN103547939A (zh) * | 2011-05-13 | 2014-01-29 | 赫克斯冈技术中心 | 用于具有扫描功能的装置的校准方法 |
CN102636774A (zh) * | 2012-04-26 | 2012-08-15 | 天津大学 | 一种基于光电扫描与超声测距的全站式空间测量定位方法 |
CN102997845A (zh) * | 2012-12-06 | 2013-03-27 | 北京理工大学 | 货车车厢体积测量系统的校准方法 |
CN105136058A (zh) * | 2015-05-14 | 2015-12-09 | 上海大学 | 激光传感三维测量系统的在线标定装置及其标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105717498A (zh) | 2016-06-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105717498B (zh) | 激光测距仪俯仰角测量与校正系统及方法 | |
US11650291B2 (en) | LiDAR sensor | |
CN105717499B (zh) | 激光测距仪偏转角测量与校正系统及方法 | |
WO2018196391A1 (zh) | 一种车载摄像机的外部参数标定方法及装置 | |
US11486988B2 (en) | Method for calibrating the alignment of a moving object sensor | |
EP2312330A1 (en) | Graphics-aided remote position measurement with handheld geodesic device | |
CN105737852B (zh) | 激光测距仪位置测量与校正系统及方法 | |
CN110501712B (zh) | 无人驾驶中用于确定位置姿态数据的方法、装置和设备 | |
EP2458405A1 (en) | Graphics-aided remote position measurement with handheld geodesic device | |
US9886933B2 (en) | Brightness adjustment system and method, and mobile terminal | |
KR102539287B1 (ko) | 라이다 센서의 신뢰성에 따른 차량 제어 장치 및 방법 | |
CN111750825A (zh) | 一种基于cmos图像测量的沉降监测系统及方法 | |
CN112154330A (zh) | 用于角度测量的系统和方法 | |
US9587931B2 (en) | Position compensation device using visible light communication and method thereof | |
US20160011294A1 (en) | Apparatus and method for estimating location, electronic apparatus comprising the apparatus | |
US8744752B2 (en) | Apparatus and method for detecting locations of vehicle and obstacle | |
US11327155B2 (en) | Radar sensor misalignment detection for a vehicle | |
CN102997845A (zh) | 货车车厢体积测量系统的校准方法 | |
Ishihara et al. | Evaluation of method of measuring distance between object and walls using ultrasonic sensors | |
US11131740B2 (en) | System and method for aligning a sensor assembly | |
CN104720815B (zh) | 高度量测装置及其方法 | |
KR102151484B1 (ko) | 레이더 위치 교정 시스템 및 이의 동작 방법 | |
CN104463824B (zh) | 一种薄膜晶体管型基板检测设备的图像校正方法及装置 | |
CN105891842A (zh) | 基于摄像头和激光发射器的测高测距装置 | |
KR101779929B1 (ko) | Gnss 기반의 측량 방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right |
Effective date of registration: 20220308 Address after: Room 101-110, 1st floor, building 8, Jinsheng Industrial Park, 611 Dongguan Road, Binjiang District, Hangzhou, Zhejiang 310000 Patentee after: HANGZHOU IPLUS TECH CO.,LTD. Address before: 310051 229, room 1, No. 475 Changhe Road, Changhe street, Binjiang District, Hangzhou, Zhejiang Patentee before: HANGZHOU NANJIANG ROBOTICS Co.,Ltd. |
|
TR01 | Transfer of patent right |