CN113093215A - 一种基于激光测距的移动平台跟踪方法 - Google Patents
一种基于激光测距的移动平台跟踪方法 Download PDFInfo
- Publication number
- CN113093215A CN113093215A CN202110357506.8A CN202110357506A CN113093215A CN 113093215 A CN113093215 A CN 113093215A CN 202110357506 A CN202110357506 A CN 202110357506A CN 113093215 A CN113093215 A CN 113093215A
- Authority
- CN
- China
- Prior art keywords
- pose
- platform
- mobile platform
- laser
- tracked
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/66—Tracking systems using electromagnetic waves other than radio waves
Landscapes
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明公开了一种基于激光测距的移动平台跟踪方法,主要装置包括激光测距单元、被跟踪移动平台和主移动平台。激光测距单元由三个激光位移传感器和一块定制反光板组成,激光位移传感器安装在跟踪平台的前端面,定制反光板安装在被跟踪平台的后端面,利用激光TOF方式测量被跟踪移动平台的位姿信息。本发明的优点在于:1)测量精度高,反应快速,成本低,具有较高的适应性。2)既可以保证主移动平台运动的连续性,也可以保证跟踪的准确性。3)在两个移动平台初始位置确定的前提下,主平台可在场地环境、被跟踪平台运动状态都未知的情况下进行精确运动。4)老旧AGV改造简单,工程实际协同场景中,应用前景广泛。
Description
技术领域
本发明涉及一种应用于航空制造领域的基于激光测距的移动平台跟踪方法,其属于航空制造领域。
背景技术
在工业4.0的背景下,无人工厂不仅解放了人工劳动力,而且使生产效率大幅度提高,是未来制造业工厂的一种发展方向。在无人工厂的自动化转站和物料运输中,基于各种导航方式的AGV有着广泛的应用。在AGV技术迅速发展的今天,多移动平台协同完成单次行驶任务、基于新旧技术的移动平台共存以及临时调度其他车间移动平台的现象广泛存在,在上述过程中出现了多移动平台运行干涉、基于旧技术的移动平台无法满足运行的精度要求、临时调度的移动平台对于现场环境未知等问题,需要一种简单便捷的移动平台跟踪方法实现双移动平台的高精度协同作业和对老旧移动平台的精度升级。
因此,利用激光位移传感器和定制反光板,设计了一种基于激光测距的移动平台跟踪方法。该方法装置简单,使得主移动平台在环境未知的情况下完成对被跟踪移动平台的高精度跟踪,当老旧移动平台安装激光位移传感器并对高精度移动平台进行跟踪行驶时,也完成了一次精度升级。
发明内容
本发明公开了一种基于激光测距的移动平台跟踪方法,其主要装置包括激光测距单元、被跟踪移动平台和主移动平台。激光测距单元由三个激光位移传感器和一块定制反光板组成,激光位移传感器安装在主移动平台的前端面,定制反光板安装在被跟踪平台的后端面,对被跟踪移动平台的二维位姿在进行测量。被跟踪移动平台为前车,以一定方式运动,主移动平台为后车,需要跟随前车协同运动。本发明的跟踪方法为:主移动平台通过不断获取激光位移传感器的实测值,计算出被跟踪移动平台的相对位姿,并结合传感器测量频率计算出前车速度矢量,实现主移动平台对被跟踪移动平台的精确跟踪。
本发明的技术方案是:一种基于激光测距的移动平台跟踪方法,其包含以下步骤:
1.1.安装激光测距单元。两车协同标定时,被跟踪平台处于静止状态,根据激光测距单元的数值,调整主移动平台使两车位姿处于目标初始位姿。
1.2.两车协同运动时,根据激光测距单元数值计算被跟踪移动平台的位姿。
1.3.主移动平台依据被跟踪移动平台位姿变化,解算被跟踪平台运动速度,依据速度调整自身运动状态以实现跟踪功能。
2.一种基于激光测距的移动平台跟踪方法,所述步骤1.1包括以下内容:
2.1.在主移动平台前端面上安装三个激光位移传感器,依次记为激光传感器1、2、3,激光传感器之间的间距分别为L1-2、L2-3,激光发射方向与航向平行。
2.2.在被跟踪移动平台后端面安装定制反光板,其由三个激光传感器的接收面构成,其中两个接收面与航向垂直,另一个接收面与地面垂直,且与其余两面夹角为θ。激光位移传感器用于测量主移动平台前端面与三个接收面之间的距离,并将其发送至控制中心作为跟踪依据。
2.3.在运动的初始位置,被跟踪平台处于静止状态,调整主移动平台位姿,使三个接收面分别处于对应激光传感器的测量范围内。
根据激光测距单元的数值,调整主移动平台位姿,设置主移动平台调整阈值,即认为当调整后的移动平台的位姿与目标位姿的误差在此阈值范围内时初始定位完成。两平台的目标位姿关系为两平台航向平行、中轴线重合、航向间距为设定值。即令三个激光位移传感器数值L1,L2,L3满足:
|L1-L3|≤E1 (19)
3.一种基于激光测距的移动平台跟踪方法,所述步骤1.2包括以下内容:
3.3.首先讨论横向位姿分量与纵向位姿分量都为0时的情况,记此时激光位移传感器2的数值为l′2。
当横向位姿分量X和纵向位姿分量Y不为0时,构造辅助三角形△ABC、△DEF进行求解。在△DEF中,点F为l′2的延长线与中段反光面的交点,纵向位姿分量Y=lFG,lEF⊥lFG,横向位姿分量X=lEF。点D在反光面上,为激光器2的实际照射点,lDE⊥lEF。lDE=l2-l′2-Y,
由辅助△ABC和△DEF可列公式(24)和(25)。
联立公式(24)和(25),未知数数量等于独立方程数,有如下唯一解。
4.一种基于激光测距的移动平台跟踪方法,所述步骤1.3包括以下内容:
4.1.记激光位移传感器的测量频率为f,则两次相邻测量的间隔时间为结合两次测量的被跟踪移动平台的位姿差值ΔX、ΔY、可以通过公式(28)~(30)得到前车在二维平面内的速度矢量,即三个速度分量Vx、Vy、w。
4.2.为了提高精度,运动开始后,选取n1个连续的测量周期的Vx、Vy、w求得均值记n1个连续的测量周期结束时被跟踪移动平台位姿为X1、Y1、通过公式(31)~(33)推测经过n1·n2·T后被跟踪移动平台的位姿X′1、Y′1、
其中n1、n2为设定值,n1<10,n2>10n1,n1,n2∈N+。
同理,在第i+1个n1·T内,主移动平台以为平均速度运行。计算中心获得被跟踪移动平台速度均值和平台位姿Xi+1、Yi+1、推测出经过n1·n2·T后被跟踪移动平台的位姿X′i+1、Y′i+1、最终计算出主移动平台速度并在第i+2个n1·T内运行并重复上述计算过程。
主移动平台将重复上述运动,直至被跟踪移动平台静止。
附图说明
图1两移动平台初始位置示意图;
图2位姿解算示意图一;
图3位姿解算示意图二;
图4两车跟踪示意图。
具体实施方式
下面结合附图1-3和实施例对本发明作进一步的说明,应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
1.如图1所示,设计适合两移动平台运动的定制反光板,具体要求为:
1.1.三个反光段反光面平整,其中两端反光段所在平面重合,中间反光段所在平面与其余反光段所在平面夹角θ已知。安装完成后,三个反光段所在平面均与地面垂直。
1.3.三个反光段长度设计合理,满足跟踪运行中激光位移传感器1、2、3分别测量的是同一反光段。
2.如图1所示,安装激光位移传感器,具体要求为:
2.1.选取同一品牌型号激光位移传感器三个,要求测量频率f高,测量精度高。
2.2.激光位移传感器1、2、3分布于同一高度,且间距L1-2、L2-3合理,满足跟踪运行中激光位移传感器1、2、3分别测量的是同一反光段。
3.如图1所示,在运动初始位置,被跟踪平台处于静止状态,根据激光测距单元的数值,调整主移动平台使两平台位姿处于目标初始位姿。根据激光测距单元的数值,调整主移动平台位姿,设置主移动平台调整阈值,即认为当调整后的移动平台的位姿与目标位姿的误差在此阈值范围内时初始定位完成。两平台的目标位姿关系为两平台航向平行、中轴线重合、航向间距为设定值。即令三个激光位移传感器数值L1,L2,L3满足:
|L1-L3|≤E1 (37)
4.2.首先讨论横向位姿分量与纵向位姿分量都为0时的情况,记此时激光位移传感器2的数值为l′2。其中l′代表长度如图2所示。
当横向位姿分量X和纵向位姿分量Y不为0时,构造如图3所示的辅助三角形进行求解。
联立公式(42)和(43),未知数数量等于独立方程数,有如下唯一解。
5.每经过一个测量周期可以得到被跟踪移动平台的当前位姿,结合激光传感器的测量频率可计算出前车速度矢量,控制主移动平台跟随前车运动。
5.1.记激光位移传感器的测量频率为f,则两次相邻测量的间隔时间为结合两次测量的被跟踪移动平台的位姿差值ΔX、ΔY、可以通过公式(46)~(48)得到前车在二维平面内的速度矢量,即三个速度分量Vx、Vy、w。
5.2.为了提高精度,运动开始后,选取n1个连续的测量周期的Vx、Vy、w求得均值记n1个连续的测量周期结束时被跟踪移动平台位姿为X1、Y1、通过公式(49)~(51)推测经过n1·n2·T后被跟踪移动平台的位姿X′1、Y′1、
其中n1、n2为设定值,n1<10,n2>10n1,n1,n2∈N+。
同理,在第i+1个n1·T内,主移动平台以为平均速度运行。计算中心获得被跟踪移动平台速度均值和平台位姿Xi+1、Yi+1、推测出经过n1·n2·T后被跟踪移动平台的位姿X′i+1、Y′i+1、最终计算出主移动平台速度并在第i+2个n1·T内运行并重复上述计算过程。
主移动平台将重复上述运动,直至被跟踪移动平台静止
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下还可以作出若干改进,这些改进也应视为本发明的保护范围。
本发明未涉及部分与现有技术相同或可采用现有技术加以实现。
Claims (4)
1.一种基于激光测距的移动平台跟踪方法,其特征在于其包含以下步骤:
1.1.安装激光测距单元,两车协同标定时,被跟踪平台处于静止状态,根据激光测距单元的数值,调整主移动平台使两车位姿处于目标初始位姿;
1.2.两车协同运动时,根据激光测距单元数值计算被跟踪移动平台的位姿;
1.3.主移动平台依据被跟踪移动平台位姿变化,解算被跟踪平台运动速度,依据速度调整自身运动状态以实现跟踪功能。
2.根据权利要求1所述的一种基于激光测距的移动平台跟踪方法,其特征在于所述步骤1.1包括以下内容:
2.1.在主移动平台前端面上安装三个激光位移传感器,依次记为激光传感器1、2、3,激光传感器之间的间距分别为L1-2、L2-3,激光发射方向与航向平行;
2.2.在被跟踪移动平台后端面安装定制反光板,其由三段激光传感器的接收面构成,其中两个接收面与航向垂直,另一个接收面与地面垂直,且与其余两面夹角为θ。激光位移传感器用于测量主移动平台前端面与三个接收面之间的距离,并将其发送至控制中心作为跟踪依据;
2.3.在两车协同标定时,被跟踪平台处于静止状态,调整主移动平台位姿,使三个接收面分别处于对应激光传感器的测量范围内;
根据激光测距单元的数值,调整主移动平台位姿,设置主移动平台调整阈值,即认为当调整后的移动平台的位姿与目标位姿的误差在此阈值范围内时初始定位完成。两平台的目标位姿关系为两平台航向平行、中轴线重合、航向间距为设定值。即令三个激光位移传感器数值L1,L2,L3满足:
|L1-L3|≤E1 (1)
3.根据权利要求2所述的一种基于激光测距的移动平台跟踪方法,其特征在于所述步骤1.2包括以下内容:
3.3.首先讨论横向位姿分量与纵向位姿分量都为0时的情况,记此时激光器2的光线在反光板上的照射点为点G,其数值为l′2;
当横向位姿分量X和纵向位姿分量Y不为0时,在二维平面内构造辅助三角形ΔABC、ΔDEF进行位姿求解。在ΔDEF中,点F为l′2的延长线与中段反光面的交点,延长段lFG为纵向位姿分量Y,lEF为横向位姿分量X,lEF⊥lFG。点D在反光面上,为激光器2的实际照射点,lDE⊥lEF。lDE=l2-l′2-Y,
由辅助ΔABC和ΔDEF可列公式(6)和(7);
联立公式(6)和(7),未知数数量等于独立方程数,有如下唯一解;
4.根据权利要求3所述的一种基于激光测距的移动平台跟踪方法,其特征在于所述步骤1.3包括以下内容:
4.1.记激光位移传感器的测量频率为f,则两次相邻测量的间隔时间为结合两次测量的被跟踪移动平台的位姿差值ΔX、ΔY、可以通过公式(10)~(12)得到前车在二维平面内的速度矢量,即三个速度分量Vx、Vy、w;
4.2.为了提高精度,运动开始后,选取n1个连续的测量周期的Vx、Vy、w求得均值记n1个连续的测量周期结束时被跟踪移动平台位姿为X1、U1、通过公式(13)~(15)推测经过n1·n2·T后被跟踪移动平台的位姿X′1、Y′1、
其中n1、n2为设定值,n1<10,n2>10n1,n1,n2∈N+;
同理,在第i+1个n1·T内,主移动平台以为平均速度运行。计算中心获得被跟踪移动平台速度均值和平台位姿Xi+1、Yi+1、推测出经过n1·n2·T后被跟踪移动平台的位姿X′i+1、Yi+1、最终计算出主移动平台速度并在第i+2个n1·T内运行并重复上述计算过程;
主移动平台将重复上述运动,直至被跟踪移动平台静止。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110357506.8A CN113093215B (zh) | 2021-04-01 | 2021-04-01 | 一种基于激光测距的移动平台跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110357506.8A CN113093215B (zh) | 2021-04-01 | 2021-04-01 | 一种基于激光测距的移动平台跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113093215A true CN113093215A (zh) | 2021-07-09 |
CN113093215B CN113093215B (zh) | 2022-10-14 |
Family
ID=76672796
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110357506.8A Active CN113093215B (zh) | 2021-04-01 | 2021-04-01 | 一种基于激光测距的移动平台跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113093215B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117647964A (zh) * | 2024-01-29 | 2024-03-05 | 中航西飞民用飞机有限责任公司 | 用于飞机总装配的协同跟随移动移载平台控制系统及方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107168310A (zh) * | 2017-05-11 | 2017-09-15 | 广州市井源机电设备有限公司 | 一种agv小车精准导航的控制装置、系统及方法 |
CN107272693A (zh) * | 2017-07-18 | 2017-10-20 | 北京星航机电装备有限公司 | 基于全向车与装配工位自动对接系统及方法 |
CN109709974A (zh) * | 2019-01-04 | 2019-05-03 | 南京航空航天大学 | 一种基于激光测距的二维空间引导定位方法 |
CN110166571A (zh) * | 2018-06-08 | 2019-08-23 | 深圳勇艺达机器人有限公司 | 一种基于移动机器人的自动跟随方法和装置 |
CN110989526A (zh) * | 2019-12-10 | 2020-04-10 | 南京航空航天大学 | 一种双agv协同运载控制系统及方法 |
CN111687631A (zh) * | 2020-06-23 | 2020-09-22 | 南京航空航天大学 | 一种基于室内gps和激光测距的飞机结构件位姿自动预对齐方法 |
-
2021
- 2021-04-01 CN CN202110357506.8A patent/CN113093215B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107168310A (zh) * | 2017-05-11 | 2017-09-15 | 广州市井源机电设备有限公司 | 一种agv小车精准导航的控制装置、系统及方法 |
CN107272693A (zh) * | 2017-07-18 | 2017-10-20 | 北京星航机电装备有限公司 | 基于全向车与装配工位自动对接系统及方法 |
CN110166571A (zh) * | 2018-06-08 | 2019-08-23 | 深圳勇艺达机器人有限公司 | 一种基于移动机器人的自动跟随方法和装置 |
CN109709974A (zh) * | 2019-01-04 | 2019-05-03 | 南京航空航天大学 | 一种基于激光测距的二维空间引导定位方法 |
CN110989526A (zh) * | 2019-12-10 | 2020-04-10 | 南京航空航天大学 | 一种双agv协同运载控制系统及方法 |
CN111687631A (zh) * | 2020-06-23 | 2020-09-22 | 南京航空航天大学 | 一种基于室内gps和激光测距的飞机结构件位姿自动预对齐方法 |
Non-Patent Citations (2)
Title |
---|
李翰博 等: "基于Leader-follower 的自主车辆跟随控制器设计", 《吉林大学学报(信息科学版)》 * |
胡泊 等: "一种双车协同搬运控制技术的研究", 《电气与自动化》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117647964A (zh) * | 2024-01-29 | 2024-03-05 | 中航西飞民用飞机有限责任公司 | 用于飞机总装配的协同跟随移动移载平台控制系统及方法 |
CN117647964B (zh) * | 2024-01-29 | 2024-04-23 | 中航西飞民用飞机有限责任公司 | 用于飞机总装配的协同跟随移动移载平台控制系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113093215B (zh) | 2022-10-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Campbell et al. | Sensor technology in autonomous vehicles: A review | |
Akai et al. | Autonomous driving based on accurate localization using multilayer LiDAR and dead reckoning | |
Aono et al. | Positioning of vehicle on undulating ground using GPS and dead reckoning | |
CN106123908B (zh) | 车辆导航方法和系统 | |
Alonso et al. | Accurate global localization using visual odometry and digital maps on urban environments | |
CN103412565B (zh) | 一种具有全局位置快速估计能力的机器人定位方法 | |
CN102788591B (zh) | 基于视觉信息的机器人沿引导线巡线导航方法 | |
CN107239076A (zh) | 基于虚拟扫描与测距匹配的agv激光slam方法 | |
US20080208454A1 (en) | Path approximation for planar motion of a ground vehicle | |
CN110702091B (zh) | 一种沿地铁轨道移动机器人的高精度定位方法 | |
CN111044073B (zh) | 基于双目激光高精度agv位置感知方法 | |
Cho et al. | Map based indoor robot navigation and localization using laser range finder | |
Mäkelä | Overview of LHD navigation without artificial beacons | |
CN110763224A (zh) | 一种自动导引运输车导航方法及导航系统 | |
CN113093215B (zh) | 一种基于激光测距的移动平台跟踪方法 | |
Lee et al. | A geometric model based 2D LiDAR/radar sensor fusion for tracking surrounding vehicles | |
Śmieszek et al. | Application of Kalman filter in navigation process of automated guided vehicles | |
Zhu et al. | Real-time, environmentally-robust 3d lidar localization | |
CN117387604A (zh) | 基于4d毫米波雷达和imu融合的定位与建图方法及系统 | |
Lee et al. | LiDAR odometry survey: recent advancements and remaining challenges | |
Tham et al. | Multi-sensor fusion for steerable four-wheeled industrial vehicles | |
CN116225029B (zh) | 一种机器人路径规划方法 | |
CN117234203A (zh) | 一种多源里程融合slam井下导航方法 | |
CN116466712A (zh) | 基于cml-avg激光雷达小车的自主巡航方法及系统 | |
CN110208784A (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 |