CN107450080B - 基于视觉定位及激光测距的两车自动对接方法 - Google Patents

基于视觉定位及激光测距的两车自动对接方法 Download PDF

Info

Publication number
CN107450080B
CN107450080B CN201710888145.3A CN201710888145A CN107450080B CN 107450080 B CN107450080 B CN 107450080B CN 201710888145 A CN201710888145 A CN 201710888145A CN 107450080 B CN107450080 B CN 107450080B
Authority
CN
China
Prior art keywords
rear car
vehicle
docking
deviation
lock pin
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
Application number
CN201710888145.3A
Other languages
English (en)
Other versions
CN107450080A (zh
Inventor
梁嘉震
段三军
李波
李远桥
李明
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Specialized Machinery
Original Assignee
Beijing Institute of Specialized Machinery
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Specialized Machinery filed Critical Beijing Institute of Specialized Machinery
Priority to CN201710888145.3A priority Critical patent/CN107450080B/zh
Publication of CN107450080A publication Critical patent/CN107450080A/zh
Application granted granted Critical
Publication of CN107450080B publication Critical patent/CN107450080B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60D—VEHICLE CONNECTIONS
    • B60D1/00—Traction couplings; Hitches; Draw-gear; Towing devices
    • B60D1/24—Traction couplings; Hitches; Draw-gear; Towing devices characterised by arrangements for particular functions
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20—Instruments for performing navigational calculations
    • 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/88—Lidar systems specially adapted for specific applications

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及一种基于视觉定位及激光测距的两车自动对接方法，涉及激光测距技术领域。本发明设计了一种两车相对位姿测量方法，实现两车位姿的精确测量，进而提出了一种两车自动对接方法，减少了对接人力物力，降低了对接难度，提高了对接效率和对接精度。采用该方法的自动对接精度能达到0.5mm以内。

Description

基于视觉定位及激光测距的两车自动对接方法
技术领域
本发明涉及激光测距技术领域，具体涉及一种基于视觉定位及激光测距的两车自动对接方法。
背景技术
两车自动对接的前提是得到两车的相对位姿，相对位姿越精确，对接效果越好。
目前，针对两车对接，常见的方法是通过手工或者手工辅助电动方法进行，但手动对接效率低、耗时长、对接精度差，浪费人力。
发明内容
(一)要解决的技术问题
本发明要解决的技术问题是：如何设计一种两车自动对接方法，以减少对接人力物力，降低对接难度，提高对接效率和对接精度。
(二)技术方案
为了解决上述技术问题，本发明提供了一种基于视觉定位及激光测距的两车自动对接方法，包括以下步骤：
步骤1、将后车作为对接车，并在后车车体1上设置左右两个对接锁销2、上下左右四个激光测距传感器3和左右两个视觉定位传感器4；
步骤2、将前车作为基准车，并在前车车体6上设置与两个对接锁销2位置分别对应的两个对接锁孔7、左右两个传感器反射板8、左右两个定位二维码9；
步骤3、将前车调平到一定高度，断电停止，将后车开至前车一定距离，该距离根据四个激光测距传感器3的参数确定，待后车的两个视觉定位传感器4和四个激光测距传感器3均检测到有效数据，则通过后车自动对接控制算法控制后车移动直至对接锁销2完全***对接锁孔7，实现自动对接；
所述后车自动对接控制算法具体为：根据左上、右上，左下、右下四个激光测距传感器3测得的距离值L1、L2、L3、L4，定位二维码9中心到左右两个视觉定位传感器4中心位置的纵向位置偏差h1、h2，定位二维码9中心到左右两个视觉定位传感器4中心位置的横向位置偏差s1、s2，两个激光测距传感器3的水平距离a，两个激光测距传感器3的垂直距离b，计算两车的六自由度相对姿态；
根据计算得到的两车的六自由度相对姿态，判断两车侧倾角偏差α是否调整到位，若是，则执行下一步判断，否则调整后车悬挂侧倾；
判断两车俯仰角度偏差β是否调整到位，若是则执行下一步判断了，否则调整后车悬挂俯仰；
判断两车垂直位移偏差h是否调整到位，若是则执行下一步判断了，否则调整后车悬挂升降；
判断两车航向角度偏差θ是否调整到位，若是则进行下一步判断，否则调整后车的航向角；
判断两车左右位移偏差s是否调整到位，若是则进行下一步判断，否则调整后车的左右位移；
判断两车距离l是否调整到位，若是则进行下一步判断，否则调整后车靠近前车；
判断对接锁销2的接近开关是否捕获信号，若是则对接锁销2***对接锁孔7，否则调整后车靠近前车。
优选地，所述两车的六自由度相对姿态由两车左右位移偏差s、两车垂直位移偏差h、两车侧倾角偏差α、两车接近位移l、两车俯仰角度偏差β、两车航向角度偏差θ表征，且：
(三)有益效果
本发明设计了一种两车相对位姿测量方法，实现两车位姿的精确测量，进而提出了一种两车自动对接方法，减少了对接人力物力，降低了对接难度，提高了对接效率和对接精度。采用该方法的自动对接精度能达到0.5mm以内。
附图说明
图1是本发明的方法主要流程图；
图2是本发明的方法中对接车元件设计结构图；
图3是本发明的方法中基准车元件设计结构图。
具体实施方式
为使本发明的目的、内容、和优点更加清楚，下面结合附图和实施例，对本发明的具体实施方式作进一步详细描述。
如图1至图3所示，本发明提供了一种基于视觉定位及激光测距的两车自动对接方法，包括以下步骤：
步骤1、将后车作为对接车，并在后车车体1上设置左右两个对接锁销2、上下左右四个激光测距传感器3和左右两个视觉定位传感器4；通过选用不同精度的传感器，测得的两车位姿精度可达0.2mm以内。左边两个激光测距传感器3安装在左边对接锁销2外侧，右边两个激光测距传感器3安装在右边对接锁销2外侧，左边视觉定位传感器4安装在左边对接锁销2外侧，右边视觉定位传感器4安装在右边对接锁销2外侧。
步骤2、将前车作为基准车，并在前车车体6上设置与两个对接锁销2位置分别对应的两个对接锁孔7、左右两个传感器反射板8、左右两个定位二维码9；
步骤3、将前车调平到一定高度，断电停止，将后车开至前车一定距离，该距离根据四个激光测距传感器3的参数确定，待后车的两个视觉定位传感器4和四个激光测距传感器3均检测到有效数据，则通过后车自动对接控制算法控制后车移动直至对接锁销2完全***对接锁孔7，实现自动对接；
所述后车自动对接控制算法具体为：根据左上、右上，左下、右下四个激光测距传感器3测得的距离值L1、L2、L3、L4，定位二维码9中心到左右两个视觉定位传感器4中心位置的纵向位置偏差h1、h2，定位二维码9中心到左右两个视觉定位传感器4中心位置的横向位置偏差s1、s2，两个激光测距传感器3的水平距离a，两个激光测距传感器3的垂直距离b，计算两车的六自由度相对姿态；
根据计算得到的两车的六自由度相对姿态，判断两车侧倾角偏差α是否调整到位，若是，则执行下一步判断，否则调整后车悬挂侧倾；
判断两车俯仰角度偏差β是否调整到位，若是则执行下一步判断了，否则调整后车悬挂俯仰；
判断两车垂直位移偏差h是否调整到位，若是则执行下一步判断了，否则调整后车悬挂升降；
判断两车航向角度偏差θ是否调整到位，若是则进行下一步判断，否则调整后车的航向角；
判断两车左右位移偏差s是否调整到位，若是则进行下一步判断，否则调整后车的左右位移；
判断两车距离l是否调整到位，若是则进行下一步判断，否则调整后车靠近前车；
判断对接锁销2的接近开关是否捕获信号，若是则对接锁销2***对接锁孔7，否则调整后车靠近前车。其中，接近开关安装在对接锁销2上。
所述两车的六自由度相对姿态由两车左右位移偏差s、两车垂直位移偏差h、两车侧倾角偏差α、两车接近位移l、两车俯仰角度偏差β、两车航向角度偏差θ表征，可计算得到的结果用向量表示为：
可以看出，本发明减少了对接人力物力，降低了对接难度，提高了对接效率和对接精度。采用该方法的自动对接精度能达到0.5mm以内。
以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明技术原理的前提下，还可以做出若干改进和变形，这些改进和变形也应视为本发明的保护范围。

Claims (5)

1.一种基于视觉定位及激光测距的两车自动对接方法，其特征在于，包括以下步骤：
步骤1、将后车作为对接车，并在后车车体(1)上设置左右两个对接锁销(2)、上下左右四个激光测距传感器(3)和左右两个视觉定位传感器(4)；
步骤2、将前车作为基准车，并在前车车体(6)上设置与两个对接锁销(2)位置分别对应的两个对接锁孔(7)、左右两个传感器反射板(8)、左右两个定位二维码(9)；
步骤3、将前车调平到一定高度，断电停止，将后车开至前车一定距离，该距离根据四个激光测距传感器(3)的参数确定，待后车的两个视觉定位传感器(4)和四个激光测距传感器(3)均检测到有效数据，则通过后车自动对接控制算法控制后车移动直至对接锁销(2)完全***对接锁孔(7)，实现自动对接；
所述后车自动对接控制算法具体为：根据左上、右上，左下、右下四个激光测距传感器(3)测得的距离值L1、L2、L3、L4，定位二维码(9)中心到左右两个视觉定位传感器(4)中心位置的纵向位置偏差h1、h2，定位二维码(9)中心到左右两个视觉定位传感器(4)中心位置的横向位置偏差s1、s2，两个激光测距传感器(3)的水平距离a，两个激光测距传感器(3)的垂直距离b，计算两车的六自由度相对姿态；
根据计算得到的两车的六自由度相对姿态，判断两车侧倾角偏差α是否调整到位，若是，则执行下一步判断，否则调整后车悬挂侧倾；
判断两车俯仰角度偏差β是否调整到位，若是则执行下一步判断了，否则调整后车悬挂俯仰；
判断两车垂直位移偏差h是否调整到位，若是则执行下一步判断了，否则调整后车悬挂升降；
判断两车航向角度偏差θ是否调整到位，若是则进行下一步判断，否则调整后车的航向角；
判断两车左右位移偏差s是否调整到位，若是则进行下一步判断，否则调整后车的左右位移；
判断两车距离是否调整到位，若是则进行下一步判断，否则调整后车靠近前车；
判断对接锁销(2)的接近开关是否捕获信号，若是则对接锁销(2)***对接锁孔(7)，否则调整后车靠近前车。
2.如权利要求1所述的方法，其特征在于，所述两车的六自由度相对姿态由两车左右位移偏差s、两车垂直位移偏差h、两车侧倾角偏差α、两车接近位移l、两车俯仰角度偏差β、两车航向角度偏差θ表征，且：
3.如权利要求1所述的方法，其特征在于，左边两个激光测距传感器(3)安装在左边对接锁销(2)外侧，右边两个激光测距传感器(3)安装在右边对接锁销(2)外侧。
4.如权利要求1所述的方法，其特征在于，左边视觉定位传感器(4)安装在左边对接锁销(2)外侧，右边视觉定位传感器(4)安装在右边对接锁销(2)外侧。
5.如权利要求1至4中任一项所述的方法，其特征在于，所述接近开关安装在对接锁销(2)上。
CN201710888145.3A 2017-09-27 2017-09-27 基于视觉定位及激光测距的两车自动对接方法 Active CN107450080B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710888145.3A CN107450080B (zh) 2017-09-27 2017-09-27 基于视觉定位及激光测距的两车自动对接方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710888145.3A CN107450080B (zh) 2017-09-27 2017-09-27 基于视觉定位及激光测距的两车自动对接方法

Publications (2)

Publication Number Publication Date
CN107450080A CN107450080A (zh) 2017-12-08
CN107450080B true CN107450080B (zh) 2019-11-08

Family

ID=60497450

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710888145.3A Active CN107450080B (zh) 2017-09-27 2017-09-27 基于视觉定位及激光测距的两车自动对接方法

Country Status (1)

Country Link
CN (1) CN107450080B (zh)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106716273B (zh) * 2016-07-28 2018-11-06 深圳市大疆创新科技有限公司 多旋翼无人机及其控制方法
CN108945511B (zh) * 2018-09-12 2024-03-01 东方航空食品投资有限公司 机场车辆的防撞控制***和方法
CN110712212A (zh) * 2019-10-28 2020-01-21 广东博智林机器人有限公司 一种基于测距传感器的对位***
CN110733048B (zh) * 2019-11-05 2021-03-26 广东博智林机器人有限公司 一种对位补给机器人及其对位方法
CN113771735A (zh) * 2021-09-13 2021-12-10 重庆零壹空间科技集团有限公司 火箭发射集装箱与辅助机动桥自动对接分离***及方法
CN115742957A (zh) * 2022-11-30 2023-03-07 东土华盛科技有限公司 控制车辆对接的方法及装置、车辆

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104482934A (zh) * 2014-12-30 2015-04-01 华中科技大学 一种多传感器融合的超近距离自主导航装置与方法
CN105865449A (zh) * 2016-04-01 2016-08-17 深圳杉川科技有限公司 基于激光和视觉的移动机器人的混合定位方法
CN106885514A (zh) * 2017-02-28 2017-06-23 西南科技大学 一种基于机器视觉的深水钻井隔水管自动对接位姿检测方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20170045400A1 (en) * 2015-08-11 2017-02-16 Bradley J. Stone Oscillating Sensors at Loading Docks

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104482934A (zh) * 2014-12-30 2015-04-01 华中科技大学 一种多传感器融合的超近距离自主导航装置与方法
CN105865449A (zh) * 2016-04-01 2016-08-17 深圳杉川科技有限公司 基于激光和视觉的移动机器人的混合定位方法
CN106885514A (zh) * 2017-02-28 2017-06-23 西南科技大学 一种基于机器视觉的深水钻井隔水管自动对接位姿检测方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
基于双目视觉的主从式果园作业车辆自主跟随***设计;毕伟平等;《湖南农业大学学报(自然科学版)》;20160630;第42卷(第3期);第344-348页 *

Also Published As

Publication number Publication date
CN107450080A (zh) 2017-12-08

Similar Documents

Publication Publication Date Title
CN107450080B (zh) 基于视觉定位及激光测距的两车自动对接方法
CN109435942B (zh) 一种基于信息融合的车位线车位识别方法及装置
CN105955259B (zh) 基于多窗口实时测距的单目视觉agv的精确定位方法
US11262189B2 (en) Monitoring container transfer device on lowering container onto transport platform or lifting away from transport platform
CN106671974B (zh) 一种用于智能泊车***的车位检测方法
CN106680290B (zh) 狭窄空间的多功能检测车
CN101549683B (zh) 自动识别道路深坑与障碍物的车辆智能方法
CN104916163B (zh) 泊车位检测方法
CN111563412B (zh) 一种基于参数空间投票和贝塞尔拟合的快速车道线检测方法
CN109359409A (zh) 一种基于视觉与激光雷达传感器的车辆可通过性检测***
CN112241007A (zh) 自动驾驶环境感知传感器的标定方法、布置结构及车辆
CN201173865Y (zh) 汽车四轮定位检测仪
CN111381248B (zh) 一种考虑车辆颠簸的障碍物检测方法及***
CN101223416A (zh) 物体检测装置
CN203011704U (zh) 3d全自动四轮定位仪
KR101349954B1 (ko) 지능형 캐디로봇
CN103839264A (zh) 一种车道线的检测方法
CN104568312A (zh) 一种车辆重心高度检测方法
CN111694011A (zh) 一种摄像机和三维激光雷达数据融合的路沿检测方法
CN108437955A (zh) 一种车辆姿态的调整方法及装置
CN108074263B (zh) 视觉定位方法和***
Wang et al. Lane boundary detection based on parabola model
CN103699899A (zh) 基于等距曲线模型的车道线检测方法
CN109399464B (zh) 龙门式起重机大车姿态控制方法及装置
CN113605766A (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