CN101672913B - 激光三点动态定位方法及系统 - Google Patents
激光三点动态定位方法及系统 Download PDFInfo
- Publication number
- CN101672913B CN101672913B CN200910308901A CN200910308901A CN101672913B CN 101672913 B CN101672913 B CN 101672913B CN 200910308901 A CN200910308901 A CN 200910308901A CN 200910308901 A CN200910308901 A CN 200910308901A CN 101672913 B CN101672913 B CN 101672913B
- Authority
- CN
- China
- Prior art keywords
- base station
- main website
- laser
- microprocessor
- base
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种激光三点动态定位方法及系统,该方法为:在固定位置设置2个基站:第一基站和第二基站,在运动目标上设置主站;所述的基站发射激光到主站;所述的基站与主站无线通信连接;定义基线为第一基站和第二基线的连线;第一基站采集主站相对于第一基站与基线之间的夹角α;第二基站采集主站相对于第二基站与基线之间的夹角β;第一基站和第二基站分别将夹角α和夹角β发送给主站;主站根据夹角α、夹角β与基线长度L确定主站的位置。依据该方法构造了激光三点动态定位系统。本技术可用于对无标识环境下野外作业的运动物体进行动态定位,定位精度高、操作原理简单、实现成本低。
Description
技术领域
本发明属于自动定位技术领域,涉及激光三点动态定位方法及系统。
背景技术
自动定位技术是电子信息技术、计算机技术、控制技术等多种学科的综合,在现代工农业生产中的应用越来越广,如精细农业中的耕、种、播、收、药物喷洒、除草、信息采集、变量产量图生成及变量投入作业,工农建筑行业中的土地平整,车辆自动行走等方面,都需应用自动定位技术。
目前应用较为广泛的定位系统有全球定位系统、无线电定位、视觉定位、惯性传感器定位等。一般来说,高精度GPS定位系统复杂,造价昂贵,而价格较低的GPS系统,定位精度不够,无法对运动物体进行精确定位;无线电定位由于其工作均与无线电波的传播有关,因而在一定程度上受气候、地形、位置及电磁干扰的影响;视觉定位具有信息探测范围宽,目标信息完整等优点,但远距离定位精度差,受恶劣环境的影响较大;惯性传感器是一种自主式定位方法,完全依靠设备自主地完成定位任务,工作不受天气条件的限制,在短时间内定位精度高,长时间工作时存在累积误差,定位精度、可靠性都会下降。
发明内容
本发明的所要解决的技术问题是提供一种激光三点动态定位方法及系统,本技术可用于对无标识环境下野外作业的运动物体进行动态定位,定位精度高、操作原理简单。
为解决上述技术问题,本发明所采用的技术方案为:
一种激光三点动态定位方法,其特征在于,在固定位置设置2个基站:第一基站和第二基站,在运动目标上设置主站;所述的基站发射激光到主站;所述的基站与主站无线通信连接;定义基线为第一基站和第二基站的连线;第一基站采集主站相对于第一基站与基线之间的夹角α;第二基站采集主站相对于第二基站与基线之间的夹角β;第一基站和第二基站分别将夹角α和夹角β通过第一基站和第二基站上的无线数据传输模块发送给主站;主站根据夹角α、夹角β与基线长度L确定主站的位置。
夹角计算方法为:
当主站的激光接收器接收到基站的激光信号,主站通过无线数据传输模块向基站发送信息,要求基站将当前的夹角通过无线数据传输模块传送到主站。夹角采集的方法为:基站CPU单元通过水平回转电机控制器控制水平回转电机工作,同时记录水平回转步进电机步数,根据公式:夹角=(360°/n)*步数,将步数转换为回转角度,即基站与基线的夹角(其中,初始步数为0,步进电机细分数为n)。另外,也可以采用编码盘传感器采集夹角,编码盘随水平回转平台转动,检测传感器采集编码盘转动信息以脉冲的形式送入CPU,由CPU记录脉冲数,若编码盘解析分度为n,则根据公式:夹角=(360°/n)*脉冲数。
主站位置的计算公式为:
主站分别采用加速度传感器和陀螺仪实时检测运动目标的加速度和运动方向,并将加速度和运动方向参数发送给基站,便于基站的激光发射器实时追踪主站的激光接收器。
一种激光三点动态定位系统,其特征在于,包括2个位置固定的基站和一个设置在运动目标上的主站;所述的基站上设置有激光发射器;所述的主站上设置有激光接收器;
所述的基站包括基站微处理器、基站无线数据传输模块、水平回转电机控制器和水平回转电机;所述的基站无线数据传输模块和水平回转电机控制器均与基站微处理器连接;基站微处理器通过水平回转电机控制器控制水平回转电机;由水平回转电机带动激光发射器转动。
所述的主站包括:主站微处理器、主站无线数据传输模块、加速度传感器、陀螺仪;激光接收器与主站微处理器连接,所述的主站无线数据传输模块、加速度传感器、陀螺仪和激光接收器均与所述的主站微处理器连接;
所述的主站无线数据传输模块和基站无线数据传输模块通信连接。
基站还包括水平检测模块、水平调节电机控制器和水平调节电机;所述的水平检测模块和水平调节电机控制器均与所述的基站微处理器连接,基站微处理器通过水平调节电机控制器控制水平调节电机。
激光发射器不与基站微处理器直接连接,而是上电即工作,不停的发出激光信号。CPU是控制水平回转步进电机转动,步进电机则带动其上的激光发射器转动,使激光发射器可以追踪主站上的激光接收器。
激光接收器由光敏元件组成,通过数据选择器后直接接到主站微处理器的I/O端口,当主站的激光接收器上的光敏元件接收到激光信号时,主站微处理器的I/O将检测为高电平,此时主站微处理器将通过无线数据传输模块向基站发送信息,要求基站将当前的夹角通过无线数据传输模块传送到主站。
本发明所具有的有益效果:
本发明采用激光三点定位技术,由两个基站之间的基线距离和通过采集到的两个激光光束与基线之间的水平夹角三个参数,运用三角函数公式运算得出运动物体的实时位置坐标与速度等信息,原理与操作简单。同时,采用加速度传感器和陀螺仪实时检测运动物体的加速度和运动方向,便于基站的激光发射器实时追踪主站的激光接收器,对运动物体进行动态定位,在每次激光三点定位测算出一组定位数据后,以此数据对加速度传感器和陀螺仪所测数据进行校正,降低了累积误差。主站上的激光接收器由一些光电元件密布组成,接收面积大,可以克服由于运动物体的震动出现激光信号入射角度太大以至于接收不到信号或出现较大误差等问题,定位精度高。又由于激光具有人眼安全及较高的大气透过率、体积小、波束窄、成本低、抗电磁干扰、距离及位置探测精度高等优点,因此本发明的定位系统受外界环境影响较小、成本较低。
依据上面的分析,相对于GPS定位系统,本系统性价比高、响应速度快;相对于无线电定位系统,本系统不受位置及电磁干扰的影响;相对于视觉定位系统,本系统定位精度高、不受恶劣环境影响;相对于单惯性传感器定位方法,本系统累计误差低、定位精度高、可靠性强。
附图说明
图1基站结构示意图;
图2基站控制器框图;
图3移动主站结构示意图;
图4移动主站控制器框图;
图5激光三点动态定位原理示意图。
图中标号说明:
1-水平检测模块;2水平回转平台,3-激光发射器;4-水平回转电机,5-水平调节电机;6-支撑圆板,7-水平调节丝杆;8-可调三脚架;9-连接杆,10-基站控制器。
11-激光接收器,12-主站控制器,13-支架,14-底座。
具体实施方式
以下结合附图对本发明作进一步说明。
实施例1:
激光三点动态定位系统由两个基站和一个移动主站组成。
两个基站分别由激光发射器、水平回转平台、水平回转角度测量模块、水平检测模块和基站控制器组成。
如图1所示,整个基站固定在高度可调的三角架8上,激光发射器3安装在水平转动平台2上,水平回转平台2上还安装有水平检测模块1,水平转动平台2通过水平回转电机4带动在水平面上来回转动,该电机自带水平回转角度测量模块,水平回转电机4、水平调节电机5与支撑圆板6固接,支撑圆板6和底座9是通过三根杆连接的,三根杆分布在以圆板的圆心为中心的等边三角形的三个顶点上,其中杆10下端和底座9固接,上端和支撑圆板铰接,丝杆7下端与底座9通过螺纹连接,上端与水平调节电机5的轴固接。
2个基站的激光发射器所发射的激光分别为两种不同波长的光,便于接收时的区别。激光发射器安装在水平回转平台上,水平回转平台由水平回转电机控制,可以进行水平方向360°来回转动,同时,CPU单元测算水平回转平台上激光发射器所发光束与基线之间的水平夹角,水平调节电机和水平检测模块在安装时调节基站水平。
两个基站的控制器分别由电源模块、显示模块、键盘、CPU单元和无线数据传输模块组成。CPU单元为中央处理单元,接收基站水平回转角度测量模块和基站水平检测模块信号,控制水平回转电机和水平调节电机运转。无线数据传输模块用于基站和主站之间的通讯。
移动主站主要由主站控制器、激光接收器、支架和底座构成。如图3所示,激光接收器11和主站控制器12都与支架13固接,支架13固接在底座14上,底座14用来和其他的可移动的物体连接。
移动主站的激光接收器由一些光电传感器组成,可检测两个基站发出的不同波长的激光信号。移动主站的控制器部分由CPU单元、加速度传感器、陀螺仪单元、无线数据传输模块、电源模块、显示模块、键盘和执行输出模块组成。CPU单元为中央处理单元,可接收激光接收器的信号,即当有激光信号到激光接收器上的时候,CPU的对应I/O检测到高电平信号,在此基础上,CPU通过无线数据传输模块向基站要求传送当时的夹角。加速度传感器和陀螺仪用于测量主站所在物体的加速度和运动方向;无线数据传输模块用于基站和主站之间的通讯;执行输出用于输出控制信号控制机械运动。
工作原理:
在工作之前,将两个基站以一定的距离固定在地面上,采用水平检测模块内的倾角传感器检测水平回转平台与水平面的倾斜数据,并将检测到的倾斜数据传送到基站控制器的CPU单元,由CPU单元控制基站上的两个水平调节电机带动丝杆旋转,从而改变底座与支撑圆盘的相对角度,使水平回转平台保持水平。两个基站之间的连线定义为基线,基线长度为L。移动主站安装在运动物体上,可以随运动物体一起移动。
在检测到基站的激光信号的情况下,主站的CPU单元控制通过无线数据传输模块按一定时间间隔发送确认信号到基站,要求基站采集当时的回转角度信息,主站向基站发送确认信号的频率是CPU单元根据运动物体当前的速度信息和定位精度要求实时调整的。例如:主站移动速度为10km/小时,定位精度误差要求在3cm以内,则可以采用100Hz的频率。基站接收到信号后,通过计算步进电机步进数,采集当时水平回转平台上激光发射器激光光束与基线之间的水平夹角,如图5所示的α、β,通过无线数据传输模块传送到主站,使主站的CPU单元根据两个角度α、β信息和已知的基线长度L三个参数计算出运动物体当时的相对位置与速度信息,对运动物体进行动态定位。
加速度传感器和陀螺仪因存在累积误差,在长时间工作时精度会下降,为降低累积误差,保证激光发射器可以实时追踪到主站的激光接收器,在每次通过激光三点定位测算出一组定位信息后,以此数据为基础,再利用加速度传感器和陀螺仪的实时加速度和方向数据测算出主站所在物体的位置和速度数据,预估运动物体的运动趋势,从而控制水平回转平台带动激光发射器对主站上的激光接收器进行追踪。
运动物体尚未移动前,基站上的激光发射器所发射的激光束对准主站上的激光接收器,测出主站初始位置,便于之后的轨迹跟踪。
运动物体移动开始,主站上的加速度传感器检测运动物体的加速度,陀螺仪检测运动物体的运动方向,通过无线数据传输模块传送到基站上,基站的CPU单元依据主站初始位置、初速度及所得的加速度和运动方向数据控制水平回转电机的转动方向与速度,使水平回转平台所带激光发射器实时追踪主站上的激光接收器,从而保证主站上的激光接收器可以不间断检测到基站的激光信号。
原理框图如图5所示:
其中,L为已知的基线距离长度,α、β为激光发射器基准面与基线水平夹角,(0,0)为第一基站的位置坐标,定义为基点,(L,0)为第二基站的位置坐标,(x,y)为运动机械移动到当前位置的坐标,根据a、α、β三个参数,由公式:
可得运动物体的位置坐标信息。
Claims (3)
1.一种激光三点动态定位方法,其特征在于,在固定位置设置2个基站:第一基站和第二基站,在运动目标上设置主站;所述的基站发射激光到主站;所述的基站与主站无线通信连接;定义基线为第一基站和第二基站的连线;第一基站采集主站相对于第一基站与基线之间的夹角α;第二基站采集主站相对于第二基站与基线之间的夹角β;第一基站和第二基站分别将夹角α和夹角β通过第一基站和第二基站上的无线数据传输模块发送给主站;主站根据夹角α、夹角β与基线长度L确定主站的位置;
2个基站的激光发射器所发射的激光分别为两种不同波长的光,便于接收时的区别;
主站位置的计算公式为:
主站分别采用加速度传感器和陀螺仪实时检测运动目标的加速度和运动方向,并将加速度和运动方向参数发送给基站,便于基站的激光发射器实时追踪主站的激光接收器。
2.一种根据权利要求1所述激光三点动态定位方法的激光三点动态定位系统,其特征在于,包括2个位置固定的基站和一个设置在运动目标上的主站;所述的基站上设置有激光发射器;所述的主站上设置有激光接收器;
所述的基站包括基站微处理器、基站无线数据传输模块、水平回转电机控制器和水平回转电机;所述的基站无线数据传输模块和水平回转电机控制器均与基站微处理器连接;基站微处理器通过水平回转电机控制器控制水平回转电机;由水平回转电机带动激光发射器转动;
所述的主站包括:主站微处理器、主站无线数据传输模块、加速度传感器和陀螺仪;激光接收器与主站微处理器连接,所述的主站无线数据传输模块、加速度传感器、陀螺仪和激光接收器均与所述的主站微处理器连接;
所述的主站无线数据传输模块和基站无线数据传输模块通信连接。
3.根据权利要求2所述的激光三点动态定位系统,其特征在于,基站还包括水平检测模块、水平调节电机控制器和水平调节电机;所述的水平检测模块和水平调节电机控制器均与所述的基站微处理器连接,基站微处理器通过水平调节电机控制器控制水平调节电机。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200910308901A CN101672913B (zh) | 2009-10-27 | 2009-10-27 | 激光三点动态定位方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200910308901A CN101672913B (zh) | 2009-10-27 | 2009-10-27 | 激光三点动态定位方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101672913A CN101672913A (zh) | 2010-03-17 |
CN101672913B true CN101672913B (zh) | 2012-09-19 |
Family
ID=42020222
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200910308901A Expired - Fee Related CN101672913B (zh) | 2009-10-27 | 2009-10-27 | 激光三点动态定位方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101672913B (zh) |
Families Citing this family (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102824188B (zh) * | 2012-08-16 | 2014-06-25 | 四川瑞迪医疗科技有限公司 | 一种激光灯定位系统及定位方法 |
CN103033181B (zh) * | 2012-12-11 | 2016-02-17 | 中船重工西安东仪科工集团有限公司 | 确定第三目标的光学目标定位器 |
CN103075963B (zh) * | 2013-01-09 | 2015-09-16 | 广州创特技术有限公司 | 一种室内定位系统和方法 |
CN103345269B (zh) * | 2013-06-30 | 2017-08-25 | 湖南农业大学 | 一种激光发射装置及自动追踪方法 |
CN103308038B (zh) * | 2013-06-30 | 2015-07-15 | 湖南农业大学 | 一种使用激光接收装置进行激光光斑中心识别方法 |
CN104697112B (zh) * | 2015-03-04 | 2018-03-13 | 广东美的制冷设备有限公司 | 空调器控制方法和系统 |
CN104777452B (zh) * | 2015-04-09 | 2017-05-17 | 北京科技大学 | 一种移动设备的定位系统及定位方法 |
CN104750115B (zh) * | 2015-04-09 | 2017-03-08 | 北京科技大学 | 一种移动设备的激光主动式导航系统及导航方法 |
CN106093863B (zh) * | 2016-05-31 | 2018-08-14 | 上海乐相科技有限公司 | 一种采用激光扫描的目标定位方法及激光接收装置 |
CN108732576B (zh) * | 2017-04-18 | 2020-12-25 | 上海诺司纬光电仪器有限公司 | 借助于激光测量装置进行定位的方法及激光测量装置 |
CN107271960A (zh) * | 2017-05-26 | 2017-10-20 | 中国科学院半导体研究所 | 飞行器定位系统及其定位方法 |
JP7183017B2 (ja) * | 2018-12-11 | 2022-12-05 | 株式会社トプコン | 測量装置及び写真測量方法 |
CN110007275B (zh) * | 2019-01-25 | 2024-08-23 | 广州市慧建科技有限公司 | 一种多目标平面位置坐标定位方法及系统 |
CN110109056B (zh) * | 2019-04-24 | 2021-04-20 | 广州市慧建科技有限公司 | 一种多目标激光定位系统 |
CN110109057B (zh) * | 2019-04-24 | 2021-04-20 | 广州市慧建科技有限公司 | 一种激光定位系统 |
CN110986864A (zh) * | 2019-12-05 | 2020-04-10 | 中国农业科学院农业信息研究所 | 一种废弃宅基地改农田后土地面积测量装置 |
CN113496560A (zh) * | 2020-03-21 | 2021-10-12 | 云丁网络技术(北京)有限公司 | 一种智能锁控制方法和系统 |
CN112129261B (zh) * | 2020-09-10 | 2023-01-31 | 国网福建省电力有限公司 | 一种变角度测距仪及其使用方法 |
CN114111580B (zh) * | 2021-12-02 | 2023-07-25 | 华侨大学 | 一种基于单目视觉的自动测量系统及测量方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1477406A (zh) * | 2003-06-12 | 2004-02-25 | 上海交通大学 | 双平台多辐射源测向测时交叉定位方法 |
CN101320094A (zh) * | 2008-05-21 | 2008-12-10 | 旭丽电子(广州)有限公司 | 一种光源扫描定位系统及其定位方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5949371A (en) * | 1998-07-27 | 1999-09-07 | Trimble Navigation Limited | Laser based reflectors for GPS positioning augmentation |
-
2009
- 2009-10-27 CN CN200910308901A patent/CN101672913B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1477406A (zh) * | 2003-06-12 | 2004-02-25 | 上海交通大学 | 双平台多辐射源测向测时交叉定位方法 |
CN101320094A (zh) * | 2008-05-21 | 2008-12-10 | 旭丽电子(广州)有限公司 | 一种光源扫描定位系统及其定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN101672913A (zh) | 2010-03-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101672913B (zh) | 激光三点动态定位方法及系统 | |
CN109282811B (zh) | Uwb与智能手机互联的室内外定位系统与方法 | |
CN106802412B (zh) | 一种基于激光及无线技术的近距离移动定位系统及其方法 | |
CN105157697B (zh) | 基于光电扫描的室内移动机器人位姿测量系统及测量方法 | |
CN101063610B (zh) | 工程变形自动监测系统 | |
CN103345269A (zh) | 一种激光发射装置及自动追踪方法 | |
CN108919825A (zh) | 具备避障功能的无人机室内定位系统及方法 | |
CN102121827A (zh) | 一种移动机器人定位系统及其定位方法 | |
CN201917661U (zh) | 一种移动机器人定位系统 | |
CN106226780A (zh) | 基于激光扫描雷达的多旋翼室内定位系统及实现方法 | |
CN101169323A (zh) | 在室内用旋转靶标测量电视经纬仪动态测角精度的方法 | |
CN102589487A (zh) | 一种便携式地表粗糙度测量仪 | |
CN103278132B (zh) | 自行走式地下掘进机器人姿态测量装置及其测量方法 | |
CN203102013U (zh) | 基于北斗系统的太阳射电望远镜自动跟踪装置 | |
CN105044754A (zh) | 一种基于多传感器融合的移动平台室外定位方法 | |
CN104777452B (zh) | 一种移动设备的定位系统及定位方法 | |
CN102518160A (zh) | 一种基于gps 和激光技术的高程控制方法及系统 | |
CN116560357A (zh) | 一种基于slam的隧道巡检机器人系统及巡检控制方法 | |
CN111722623A (zh) | 一种基于蓝牙阵列天线定位的自动跟随系统 | |
US7760369B2 (en) | Apparatus and method for determining an elevation of working tools based on a laser system | |
CN110007275B (zh) | 一种多目标平面位置坐标定位方法及系统 | |
CN110471430B (zh) | 一种agv局部高精度定位导航装置 | |
CN209656897U (zh) | 一种多目标平面位置坐标定位系统 | |
CN107356902B (zh) | 一种WiFi定位指纹数据自动采集方法 | |
CN114545918A (zh) | 一种可接入移动终端的机器人巡检系统及巡检方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20120919 Termination date: 20131027 |