CN108152827B - 一种基于激光测距的全向智能移动装备定位与导航方法 - Google Patents
一种基于激光测距的全向智能移动装备定位与导航方法 Download PDFInfo
- Publication number
- CN108152827B CN108152827B CN201710900086.7A CN201710900086A CN108152827B CN 108152827 B CN108152827 B CN 108152827B CN 201710900086 A CN201710900086 A CN 201710900086A CN 108152827 B CN108152827 B CN 108152827B
- Authority
- CN
- China
- Prior art keywords
- agv
- sensor
- center
- navigation
- laser
- 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
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/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/50—Systems of measurement based on relative movement of target
- G01S17/58—Velocity or trajectory determination systems; Sense-of-movement determination systems
-
- 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
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于激光测距的全向智能移动装备定位与导航方法,包括如下步骤:在AGV上安装传感器,并测量传感器中心至AGV中心的距离;在AGV运行场地内安装激光反射板;设定传感器的初始原点和零度角,利用导航控制器采集传感器的实时位姿信息并进行滤波,获得传感器的当前位姿信息;通过转换公式得出AGV车体中心的当前位姿信息;在AGV巡线运行时,实时解算AGV车体中心的当前位姿信息与目标路径的偏差,根据偏差实时调整AGV的角速度和偏航角,完成导航。本发明通过布设传感器和激光反射板,并实时解算AGV位姿与目标路径的偏差,根据偏差实时调整AGV,实现了灵活设置AGV运行路线并精确导航,弥补了传统的激光导航AGV定位方法路径单一且可靠性较差的缺陷。
Description
技术领域
本发明涉及一种基于激光测距的全向智能移动装备定位与导航方法,尤其适用于AGV运行区域定位与导航,属于AGV导航控制技术领域。
背景技术
现有的AGV生产厂家采用的导航方式包括:视觉导航、激光导航、磁导航、光电导航等。磁导航主要优点是引线隐蔽,不易污染和破损,导引原理简单而可靠,便于控制和通讯,对声光无干扰,制造成本较低。缺点是路径难以更改扩展,对复杂路径的局限性大。
GPS导航是通过卫星对非固定路面系统中的控制对象进行跟踪和制导,目前此项技术还在发展和完善,通常用于室外远距离的跟踪和制导,其精度取决于卫星在空中的固定精度和数量,以及控制对象周围环境等因素。由此发展出来的是iGPS(室内GPS)和dGPS(用于室外的差分GPS),其精度要远远高于民用GPS,但制造成本较高。
视觉导航是对AGV行驶区域的环境进行图象处理和智能学习,实现自动导航行驶,视觉导航主要特点是精度较高,但对复杂环境的识别能力和学习能力有待提高,而且路径单一。
激光导航AGV定位较精确;地面无需其它辅助定位设施;行驶路径可灵活多变,能够适合多种现场环境,它是目前国外许多AGV生产厂家优先采用的先进导航方法。
现有技术中,传统的激光导航AGV定位方法存在运行路径单一且可靠性较差的问题。
发明内容
本发明解决的技术问题是:克服现有技术的不足,本发明提供了一种基于激光测距的全向智能移动装备定位与导航方法,通过合理布设传感器和激光反射板,并实时解算AGV车体中心的当前位姿信息与目标路径的偏差,根据偏差实时调整AGV的角速度和偏航角,实现了灵活设置AGV运行路线并精确导航,弥补了传统的激光导航AGV定位方法路径单一且可靠性较差的缺陷。
本发明的技术解决方案是:
一种基于激光测距的全向智能移动装备定位与导航方法,包括如下步骤:
第一步,在AGV顶部安装传感器,并测量传感器中心至AGV车体中心的距离d;
第二步,在AGV运行场地内安装激光反射板,使传感器在任意时刻均能照射到不少于3块激光反射板;
第三步,设定传感器的初始原点和零度角,在所述场地内使用传感器照射激光反射板,利用导航控制器采集传感器的实时位姿信息并进行滤波,获得传感器的当前位姿信息;
第四步,根据传感器的当前位姿信息,通过转换公式得出AGV车体中心的当前位姿信息;
第五步,在AGV巡线运行时,实时解算AGV车体中心的当前位姿信息与目标路径的偏差,根据偏差实时调整AGV的角速度和偏航角,完成导航。
在上述的一种基于激光测距的全向智能移动装备定位与导航方法中,所述第一步中,传感器采用激光导航传感器,传感器发射光束的照射范围是0~360°。
在上述的一种基于激光测距的全向智能移动装备定位与导航方法中,所述第一步中,传感器位于AGV车体前后轴线上且与AGV车头方向平行。
在上述的一种基于激光测距的全向智能移动装备定位与导航方法中,所述第二步中,激光反射板的数量不少于11块,激光反射板与传感器的间距范围设为10~20m,AGV单侧的激光反射板采用非等间距设置,AGV单侧相邻的激光反射板之间的距离范围设为10~15m。
在上述的一种基于激光测距的全向智能移动装备定位与导航方法中,所述第三步中,根据传感器与激光反射板的距离,得出传感器的实时位姿信息,传感器的当前位姿信息包括传感器的当前坐标(x1,y1)和传感器的当前位姿角θ1。
在上述的一种基于激光测距的全向智能移动装备定位与导航方法中,所述第三步中,传感器的当前坐标(x1,y1)均在第一象限内。
在上述的一种基于激光测距的全向智能移动装备定位与导航方法中,所述第三步中,导航控制器通过串口/网口实时采集传感器的实时位姿信息。
在上述的一种基于激光测距的全向智能移动装备定位与导航方法中,所述第五步中,AGV车体中心的当前位姿信息与目标路径的偏差包括AGV车体中心的当前坐标(x′,y′)与目标路径的偏移距离Δd,AGV车体中心的当前坐标(x′,y′)与目标坐标(xs,yf)的偏移距离Δl,AGV车体中心的当前位姿角θ′与目标路径倾斜角θ的偏差角度Δθ。
步骤5.1,建立目标路径方程y=k(x′-xs)+ys,其中:k为目标路径倾斜角θ的正切值,当预设AGV车体中心至目标路径的最远距离为dmax,将AGV运行方向和AGV车头方向之间的夹角定义为AGV的偏航角 的取值范围是[0°,360°),AGV向前方即AGV车头方向运行时,AGV的偏航角为0°;
当0°≤θ′<90°;
当90°≤θ′<180°;
当180°≤θ′<270°;
当270°≤θ′<360°;
步骤5.3,计算AGV的角速度ω以及旋转方向;
ω的取值范围是[-45°,45°];
若Δθ′>0,则AGV应顺时针旋转;
若Δθ′<0,则AGV应逆时针旋转;
若Δθ′=0,则AGV无需旋转;
本发明与现有技术相比的有益效果是:
【1】本发明采用激光导航传感器,并使激光导航传感器中心坐标与AGV车体中心坐标一一对应,有效确保AGV当前位姿信息测量的精确性和连续性,而且可以根据实际需要,在AGV运行场地内灵活设置激光反射板的位置和数量,实现了全范围任意点的准确定位,增强了AGV运行路线的多样性。
【2】本发明将麦克纳姆轮AGV的全向运行和激光导航传感器连续定位相结合,达到了AGV定位精度优于±5mm的效果;相较于普通视觉或磁导AGV,运行路径更加多变,通用性能获得了显著的提升。
【3】本发明逻辑通顺、思路清晰、设计合理,易于工程实现;导航过程安全稳定,既减轻了工作人员的操作负担,又大幅降低了操作成本,市场应用前景非常广阔。
附图说明
附图用来提供对本发明的进一步理解,构成本申请的一部分,本发明的实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为本发明的流程图
图2为传感器布设示意图
图3为传感器中心坐标和AGV车体中心坐标的关系示意图
图4为AGV车体中心的当前位姿信息与目标路径的偏差关系示意图
具体实施方式
为使本发明的方案更加明了,下面结合附图说明和具体实施例对本发明作进一步描述:
如图1所示,一种基于激光测距的全向智能移动装备定位与导航方法,包括如下步骤:
第一步,在AGV顶部安装传感器,并测量传感器中心至AGV车体中心的距离d;
第二步,在AGV运行场地内安装激光反射板,使传感器在任意时刻均能照射到不少于3块激光反射板;
第三步,设定传感器的初始原点和零度角,在所述场地内使用传感器照射激光反射板,利用导航控制器采集传感器的实时位姿信息并进行滤波,获得传感器的当前位姿信息;
第四步,根据传感器的当前位姿信息,通过转换公式得出AGV车体中心的当前位姿信息;
第五步,在AGV巡线运行时,实时解算AGV车体中心的当前位姿信息与目标路径的偏差,根据偏差实时调整AGV的角速度和偏航角,完成导航。
优选的,第一步中,传感器采用激光导航传感器,传感器发射光束的照射范围是0~360°。
优选的,第一步中,传感器位于AGV车体前后轴线上且与AGV车头方向平行。
如图2所示,优选的,第二步中,激光反射板的数量不少于11块,激光反射板与传感器的间距范围设为10~20m,AGV单侧的激光反射板采用非等间距设置,AGV单侧相邻的激光反射板之间的距离范围设为10~15m。
优选的,第三步中,根据传感器与激光反射板的距离,得出传感器的实时位姿信息,传感器的当前位姿信息包括传感器的当前坐标(x1,y1)和传感器的当前位姿角θ1。
优选的,第三步中,传感器的当前坐标(x1,y1)均在第一象限内。
优选的,第三步中,导航控制器通过串口/网口实时采集传感器的实时位姿信息。
如图4所示,优选的,第五步中,AGV车体中心的当前位姿信息与目标路径的偏差包括AGV车体中心的当前坐标(x′,y′)与目标路径的偏移距离Δd,AGV车体中心的当前坐标(x′,y′)与目标坐标(xs,yf)的偏移距离Δl,AGV车体中心的当前位姿角θ′与目标路径倾斜角θ的偏差角度Δθ;
已知目标路径的起始坐标(xs,ys)和终点坐标(xs,yf),假设目标路径的直线式方程为y=k(x-xs)+ys,其中将直线式方程转换为Ax+By+C=0,导出A=yf-ys,B=xs-xf,C=xfys-xsyf;
当xs=xf,Δd=|x′-xs|;
当ys=yf,Δd=|y′-ys|;
将AGV车体中心的当前坐标x′代入目标路径方程y=k(x′-xs)+ys中,得出的y与y′进行比较,当预设AGV车体中心至目标路径的最远距离为dmax,将AGV运行方向和AGV车头方向之间的夹角定义为AGV的偏航角 的取值范围是[0°,360°),AGV向前方即AGV车头方向运行时,AGV的偏航角为0°;
当0°≤θ′<90°;
当90°≤θ′<180°;
当180°≤θ′<270°;
当270°≤θ′<360°;
步骤5.3,计算AGV的角速度ω以及旋转方向;
ω的取值范围是[-45°,45°];
若Δθ′>0,则AGV应顺时针旋转;
若Δθ′<0,则AGV应逆时针旋转;
若Δθ′=0,则AGV无需旋转;
本发明说明书中未详细描述的内容为本领域技术人员公知技术。
Claims (8)
1.一种基于激光测距的全向智能移动装备定位与导航方法,其特征在于:包括如下步骤:
第一步,在AGV顶部安装传感器,并测量传感器中心至AGV车体中心的距离d;
第二步,在AGV运行场地内安装激光反射板,使传感器在任意时刻均能照射到不少于3块激光反射板;
第三步,设定传感器的初始原点和零度角,在所述场地内使用传感器照射激光反射板,利用导航控制器采集传感器的实时位姿信息并进行滤波,获得传感器的当前位姿信息;
第四步,根据传感器的当前位姿信息,通过转换公式得出AGV车体中心的当前位姿信息;
第五步,在AGV巡线运行时,实时解算AGV车体中心的当前位姿信息与目标路径的偏差,根据偏差实时调整AGV的角速度和偏航角,完成导航;
所述第五步中,AGV车体中心的当前位姿信息与目标路径的偏差包括AGV车体中心的当前坐标(x′,y′)与目标路径的偏移距离Δd,AGV车体中心的当前坐标(x′,y′)与目标坐标(xs,ys)的偏移距离Δl,AGV车体中心的当前位姿角θ′与目标路径倾斜角θ的偏差角度Δθ;
步骤5.1,建立目标路径方程y=k(x′-xs)+ys,其中:k为目标路径倾斜角θ的正切值,当预设AGV车体中心至目标路径的最远距离为dmax,将AGV运行方向和AGV车头方向之间的夹角定义为AGV的偏航角 的取值范围是[0°,360°),AGV向前方即AGV车头方向运行时,AGV的偏航角为0°;
当0°≤θ′<90°;
当90°≤θ′<180°;
当180°≤θ′<270°;
当270°≤θ′<360°;
步骤5.3,计算AGV的角速度ω以及旋转方向;
ω的取值范围是[-45°,45°];
若Δθ>0,则AGV应顺时针旋转;
若Δθ<0,则AGV应逆时针旋转;
若Δθ=0,则AGV无需旋转;
2.根据权利要求1所述的一种基于激光测距的全向智能移动装备定位与导航方法,其特征在于:所述第一步中,传感器采用激光导航传感器,传感器发射光束的照射范围是0~360°。
3.根据权利要求2所述的一种基于激光测距的全向智能移动装备定位与导航方法,其特征在于:所述第一步中,传感器位于AGV车体前后轴线上且与AGV车头方向平行。
4.根据权利要求1所述的一种基于激光测距的全向智能移动装备定位与导航方法,其特征在于:所述第二步中,激光反射板的数量不少于11块,激光反射板与传感器的间距范围设为10~20m,AGV单侧的激光反射板采用非等间距设置,AGV单侧相邻的激光反射板之间的距离范围设为10~15m。
5.根据权利要求1所述的一种基于激光测距的全向智能移动装备定位与导航方法,其特征在于:所述第三步中,根据传感器与激光反射板的距离,得出传感器的实时位姿信息,传感器的当前位姿信息包括传感器的当前坐标(x1,y1)和传感器的当前位姿角θ1。
6.根据权利要求5所述的一种基于激光测距的全向智能移动装备定位与导航方法,其特征在于:所述第三步中,传感器的当前坐标(x1,y1)均在第一象限内。
7.根据权利要求1所述的一种基于激光测距的全向智能移动装备定位与导航方法,其特征在于:所述第三步中,导航控制器通过串口/网口实时采集传感器的实时位姿信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710900086.7A CN108152827B (zh) | 2017-09-28 | 2017-09-28 | 一种基于激光测距的全向智能移动装备定位与导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710900086.7A CN108152827B (zh) | 2017-09-28 | 2017-09-28 | 一种基于激光测距的全向智能移动装备定位与导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108152827A CN108152827A (zh) | 2018-06-12 |
CN108152827B true CN108152827B (zh) | 2020-09-18 |
Family
ID=62468593
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710900086.7A Active CN108152827B (zh) | 2017-09-28 | 2017-09-28 | 一种基于激光测距的全向智能移动装备定位与导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108152827B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108896041A (zh) * | 2018-06-20 | 2018-11-27 | 中国计量大学 | 基于超声波的惯性导引车导航方法及导引车 |
CN108871313A (zh) * | 2018-07-10 | 2018-11-23 | 珠海亿智电子科技有限公司 | 一种基于地理坐标的新型轨迹偏离报警方法 |
CN110379044B (zh) * | 2018-09-13 | 2023-01-31 | 北京京东乾石科技有限公司 | 一种运动误差补偿的方法和装置 |
CN111694017B (zh) * | 2018-10-15 | 2022-10-21 | 明度智云(浙江)科技有限公司 | 一种移动机器人精准定位方法 |
CN110361748A (zh) * | 2019-07-18 | 2019-10-22 | 广东电网有限责任公司 | 一种基于激光测距的移动装置导航方法、相关设备及产品 |
CN110488834A (zh) * | 2019-08-27 | 2019-11-22 | 北京特种机械研究所 | 一种航天器高精度自动转运装置及其定位方法 |
CN110530399B (zh) * | 2019-09-06 | 2023-03-24 | 苏州寻迹智行机器人技术有限公司 | 双轮差速移动机器人里程计标定的轮间距修正方法 |
CN110837257B (zh) * | 2019-11-19 | 2023-12-29 | 北京卫星制造厂有限公司 | 一种基于iGPS与视觉的AGV复合定位导航系统 |
CN111044073B (zh) * | 2019-11-26 | 2022-07-05 | 北京卫星制造厂有限公司 | 基于双目激光高精度agv位置感知方法 |
CN111123985B (zh) * | 2020-01-14 | 2023-08-11 | 北京卫星制造厂有限公司 | 一种基于激光扫描的多车自动调姿跟随系统 |
CN111176299A (zh) * | 2020-01-22 | 2020-05-19 | 广州富港万嘉智能科技有限公司 | 车辆位置调整方法、计算机可读存储介质、agv控制系统及agv小车 |
CN112462331B (zh) * | 2020-11-06 | 2023-09-05 | 三一海洋重工有限公司 | 定位装置和定位方法 |
CN112556576B (zh) * | 2020-12-07 | 2022-06-21 | 兰剑智能科技股份有限公司 | 双激光扫描仪校准方法、装置及设备 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102323820A (zh) * | 2011-04-19 | 2012-01-18 | 江苏科技大学 | 一种智能舵系统及其控制方法 |
CN102890511B (zh) * | 2012-10-31 | 2015-06-24 | 中研技术有限公司 | 一种激光导引的sd型agv系统的导引方法 |
JP2014191689A (ja) * | 2013-03-28 | 2014-10-06 | Hitachi Industrial Equipment Systems Co Ltd | 移動体の走行制御手段に対して制御指令を出力する位置検出装置を取り付けた移動体及びその位置検出装置 |
JP6791616B2 (ja) * | 2015-04-27 | 2020-11-25 | トヨタ自動車株式会社 | 自動運転車両システム |
CN107102641B (zh) * | 2017-05-18 | 2020-08-07 | 湖北工业大学 | 一种基于激光引导双轮差速agv的原地偏航旋转方法 |
-
2017
- 2017-09-28 CN CN201710900086.7A patent/CN108152827B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108152827A (zh) | 2018-06-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108152827B (zh) | 一种基于激光测距的全向智能移动装备定位与导航方法 | |
CN107463173B (zh) | 仓储agv导航方法及装置、计算机设备及存储介质 | |
CN111044073B (zh) | 基于双目激光高精度agv位置感知方法 | |
US9758239B2 (en) | System and method for controlling an unmanned air vehicle | |
CN105300375B (zh) | 一种基于单视觉的机器人室内定位和导航方法 | |
CN110837257B (zh) | 一种基于iGPS与视觉的AGV复合定位导航系统 | |
CN104750115B (zh) | 一种移动设备的激光主动式导航系统及导航方法 | |
CN106647730B (zh) | 一种前方随行系统及随行方法和智能移动平台 | |
CN111176298B (zh) | 一种无人车轨迹录制与轨迹跟踪方法 | |
CN109900273B (zh) | 一种室外移动机器人导引方法及导引系统 | |
CN113534184B (zh) | 一种激光感知的农业机器人空间定位方法 | |
CN104316949A (zh) | 一种无人机搜索目标快速定位方法 | |
CN111487976B (zh) | 一种倒车轨迹跟踪方法 | |
CN109341701A (zh) | 基于激光跟踪全站仪的地面机器人航向角实时获取方法 | |
KR20200083301A (ko) | 이동하는 오브젝트 센서의 정렬을 교정하기 위한 방법 | |
CN115027482A (zh) | 智能驾驶中的融合定位方法 | |
CN115167440A (zh) | 一种基于虚拟领航-领航-跟随的多机器人编队控制方法 | |
CN102436260A (zh) | 一种室内自主定位与定向的二维导航系统 | |
CN110441760A (zh) | 一种基于先验地形图的大范围海底地形图拓展构图方法 | |
CN115855041A (zh) | 一种农业机器人定位方法、系统及装置 | |
CN110375747A (zh) | 一种室内无人机的惯导系统 | |
CN110209170A (zh) | 一种停车机器人的行进轨迹矫正方法 | |
CN108227702A (zh) | 一种基于iGPS的AGV定位导航方法、系统和存储介质 | |
CN113093215B (zh) | 一种基于激光测距的移动平台跟踪方法 | |
CN115145275A (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 |