CN111679292A - 一种用于agv小车激光导航的相对定位方法 - Google Patents

一种用于agv小车激光导航的相对定位方法 Download PDF

Info

Publication number
CN111679292A
CN111679292A CN202010593878.6A CN202010593878A CN111679292A CN 111679292 A CN111679292 A CN 111679292A CN 202010593878 A CN202010593878 A CN 202010593878A CN 111679292 A CN111679292 A CN 111679292A
Authority
CN
China
Prior art keywords
obtaining
boundary graph
agv
laser radar
boundary
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
Application number
CN202010593878.6A
Other languages
English (en)
Other versions
CN111679292B (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.)
Kunshan Tongfu Intelligent Technology Co ltd
Original Assignee
Kunshan Tongfu Intelligent Technology Co ltd
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 Kunshan Tongfu Intelligent Technology Co ltd filed Critical Kunshan Tongfu Intelligent Technology Co ltd
Priority to CN202010593878.6A priority Critical patent/CN111679292B/zh
Publication of CN111679292A publication Critical patent/CN111679292A/zh
Application granted granted Critical
Publication of CN111679292B publication Critical patent/CN111679292B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0257Control of position or course in two dimensions specially adapted to land vehicles using a radar

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

一种用于AGV小车激光导航的相对定位方法,包括有AVG小车以及激光雷达,包括有:S1、激光雷达扫描周围环境,获所距离以及角度信息获得周围环境的边界图形;S2、建立AVG小车在边界图形内的局部直角坐标系;S3、获得边界图形的重心点,将重心点记为P(X,Y);S4、获得边界图形对于重心点的惯量矩阵,获得相邻时刻下AGV小车所在位置的方向角变化量;S5、将后一时刻的AGV小车正方向旋转到与前一时刻AGV小车正方向一致;S6、获得旋转后一时刻边界图形的重心位置坐标,然后将两相邻时刻的重心位置坐标相减得到相对位移,通过采用相对定位方法实现AGV小车不依靠反光板的设置实现自身在室内空间内的定位以及导航,减少了在室内设置多个反光板所占据的空间。

Description

一种用于AGV小车激光导航的相对定位方法
技术领域
本发明涉及AGV高精度定位技术领域,具体涉及一种用于AGV小车激光导航的相对定位方法。
背景技术
激光雷达技术广泛应用在AGV、无人驾驶等领域,基于激光雷达技术的AGV凭借其较高的稳定性,较高的定位精度,以及对场景依赖性小的特性,广泛应用在货物运输、快递运输等领域。激光雷达主要应用于AGV的自身定位,目前主流的定位方式是基于反光板的三角定位算法。
申请号为CN201910326851.8的中国专利公开了一种激光导航AGV的高精度定位方法,基于卡尔曼滤波的算法来提高定位的稳定性,解决AGV小车在运动过程中定位的延时性,这极大地提高了AGV的运行速度。
但是在相对封闭的室内反光板的设置会占据室内的空间,影响对室内空间的利用,现有技术存在改进之处。
发明内容
为解决上述技术问题,本发明提出了一种用于AGV小车激光导航的相对定位方法,提供了在室内封闭环境下不使用反光板作为参考点的相对定位方法,消除了设置在室内的反光板,提高对室内空间的利用率。
为达到上述目的,本发明的技术方案如下:一种用于AGV小车激光导航的相对定位方法,包括有AVG小车以及激光雷达,其特征在于,包括有以下步骤:
S1、所述激光雷达扫描周围环境,根据激光雷达所取得的距离以及角度信息获得周围环境的边界图形;
S2、建立AVG小车在边界图形内的局部直角坐标系;
S3、获得边界图形的重心点,将重心点记为P(X,Y);
S4、获得边界图形对于重心点的惯量矩阵,获得相邻时刻下AGV小车所在位置的方向角变化量;
S5、将后一时刻的AGV小车正方向旋转到与前一时刻AGV小车正方向一致;
S6、获得旋转后一时刻边界图形的重心位置坐标,然后将两相邻时刻的重心位置坐标相减就即可得到两相邻时刻的相对位移。
本发明进一步设置为:其中所述S2中建立如下的局部直角坐标系,
Figure BDA0002555343730000021
其中,l为激光雷达到边界图形之间的距离,θ为对应的角度信息。
本发明进一步设置为:其中所述S3中获得边界图形的重心点的具体步骤包括有:
A1、在边界图形内任取一确定的空间直角坐标系O-xy,则边界图形可微元出i个质点,每个质点对应各自坐标(xi,yi)及质量mi
A2、令M=m1+m2+…+mi,该边界图形的重心为P(X,Y);
则有:X=(x1m1+x2m2+…+ximi)/M;Y=(y1m1+y2m2+…+yimi)/M;
A3、其中0点为激光雷达所在位置,A点为其中一个扫描点,β为角分辨率,θi表示的是第i个点的角度信息,l为激光雷达测得的A点到激光雷达的位置距离,设A′为等腰三角形的重心位置,A′与O点之间的距离为2/3S,则有
Figure BDA0002555343730000022
Figure BDA0002555343730000023
质量权重用三角形的面积来表示:
Figure BDA0002555343730000024
将xi、yi、mi代入所述A2中即可得到重心P的坐标。
本发明进一步设置为:其中,所述S4中惯量矩阵的求取具体包括以下步骤:
B1、将激光雷达扫描得到的边界图形看作刚体,将每个扫描点看作质点,根据转动惯量公式:
Figure BDA0002555343730000025
Figure BDA0002555343730000026
Figure BDA0002555343730000027
其中,(xi,yi)是将坐标系平移到以重心为坐标原点下各点的坐标值并建立参考直角坐标系,可以得到分别绕参考直角坐标系下x轴、y轴的转动惯量;
B2、得到该体系对于重心的惯量矩阵:
Figure BDA0002555343730000028
B3、得到了惯量主轴以及惯量主轴与坐标轴之间的夹角,其中特征向量表示的是长短轴在参考直角坐标系中的方向,得到获得相邻时刻下两个边界图形的相对旋转角度。
本发明进一步设置为:其中所述S6中包括有:所述位移变化量的求取将后一时刻的AGV小车正方向旋转到与前一时刻AGV小车正方向一致,再次根据所述S4求出旋转后后一时刻边界图形的重心位置坐标(X‘2,Y‘2),然后将后一时刻边界图形的重心位置坐标与S3中得到的前一时刻的重心位置坐标(X1,Y1)相减就可得到两时刻的相对位移Δx=X1-X2‘;Δy=Y1-Y‘2
综上所述,本发明具有以下效果:
通过采用相对定位方法实现AGV小车不依靠反光板的设置实现自身在室内空间内的定位以及导航,减少了在室内设置多个反光板所占据的空间,大大提高了室内空间的利用率。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍。
图1为激光雷达扫描示意图;
图2为边界图形示意图;
图3为相对定位方法的流程图;
图4为质量权重求取示意图;
图5为旋转后的两时刻重心示意图;
图6为惯量主轴示意图;
图7为坐标转换示意图。
图中:1、AGV小车;2、激光雷达。
具体实施方式
下面结合附图对本发明作进一步详细的说明。
如图1至图4所示,一种用于AGV小车激光导航的相对定位方法,包括有AVG小车以及激光雷达,包括有以下步骤:
S1、激光雷达扫描周围环境,根据激光雷达所取得AGV小车与周围环境的距离以及角度信息获得周围环境的边界图形;
S2、建立AVG小车在边界图形内的局部直角坐标系,以AVG小车所在位置为O点建立O-xy坐标系;
S3、获得边界图形的重心点,将重心点记为P(X,Y);
S4、获得边界图形对于重心点的惯量矩阵,获得相邻时刻下AGV小车所在位置的方向角变化量;
S5、将后一时刻的AGV小车正方向旋转到与前一时刻AGV小车正方向一致;
S6、获得旋转后一时刻边界图形的重心位置坐标,然后将其与中得到的前一时刻的重心位置坐标相减就可得到两时刻的相对位移。
进一步的,其中在S2中建立如下的局部直角坐标系:
Figure BDA0002555343730000041
其中,l为激光雷达到边界图形之间的距离,θ为对应的角度信息。
结合图4所示,其中S3中获得边界图形的重心点的具体步骤包括有:
A1、在边界图形内任取一确定的空间直角坐标系O-xy,则边界图形可微元出i个质点,每个质点对应各自坐标(xi,yi)及质量mi
A2、令M=m1+m2+…+mi,该边界图形的重心为P(X,Y);
则有:X=(x1m1+x2m2+…+ximi)/M;Y=(y1m1+y2m2+…+yimi)/M;
A3、其中0点为激光雷达所在位置,A点为其中一个扫描点,β为角分辨率,θi表示的是第i个点的角度信息,激光雷达扫描四周360°环境,会得到n个点。可对激光雷达的角分辨率进行设置,若角分辨率β为0.25°,会得到(360/0.25=1440)个点;若角分辨率β为0.15°,会得到(360/0.25=2400)个点,以角分辨率为0.15°为例,扫描到2400个点,第一个点(L1,θ1),第二个点(L2,θ2)……。在实际扫描中两个点之间的角度差θ21≈角分辨率β为0.15°;l为激光雷达测得的A点到激光雷达的位置距离,设A′为等腰三角形的重心位置,A′与0点之间的距离为2/3S,则有
Figure BDA0002555343730000042
Figure BDA0002555343730000043
质量权重用三角形的面积来表示:
Figure BDA0002555343730000044
将xi、yi、mi代入A2中即可得到重心P的坐标。
结合图5、图6和图7所示,其中,S4中惯量矩阵的求取具体包括以下步骤:
B1、将激光雷达扫描得到的边界图形看作刚体,将每个扫描点看作质点,根据转动惯量公式:
Figure BDA0002555343730000051
Figure BDA0002555343730000052
Figure BDA0002555343730000053
其中,(xi,yi)是将坐标系平移到以重心为坐标原点下各点的坐标值并建立参考直角坐标系,可以得到分别绕参考直角坐标系下x轴、y轴的转动惯量;
参考直角坐标系与局部直角坐标系的关系是:局部直角坐标系的原点是激光雷达,参考直角坐标系的原点是边界图形的中心,两者的x轴平行,y轴平行;
B2、得到该体系对于重心的惯量矩阵:
Figure BDA0002555343730000054
B3、得到了惯量主轴以及惯量主轴与坐标轴之间的夹角,其中特征向量表示的是长短轴在参考直角坐标系中的方向,得到获得相邻时刻下两个边界图形的相对旋转角度。
T1时刻的惯量矩阵为I1,T2时刻的惯量矩阵为I2。可得到I1的特征向量为V1,D1。
I2的特征向量为V2,D2。利用特征向量可得到相对旋转角度:V1=(V11,V12),V2=(V21,V22),根据三角函数可以得到:A1=arctan(V11/V12)A2=arctan(V21/V22),则有:旋转角度为ΔA=A2-A1。
在转动后边界图形的坐标位置也随之发生了改变,即角度由θ变为了(θ-ΔA),在求重心坐标的时候公式为:
Figure BDA0002555343730000055
Figure BDA0002555343730000056
Figure BDA0002555343730000057
(质量权重不变)
其中所述S6中包括有:所述位移变化量的求取将后一时刻的AGV小车正方向旋转到与前一时刻AGV小车正方向一致,再次根据所述S4求出旋转后后一时刻边界图形的重心位置坐标(X‘2,Y‘2),然后将后一时刻边界图形的重心位置坐标与S3中得到的前一时刻的重心位置坐标(X1,Y1)相减就可得到两时刻的相对位移Δx=X1-X‘2;Δy=Y1-Y‘2
应当指出,对于本领域的普通技术人员来说,在不脱离本发明创造构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。

Claims (5)

1.一种用于AGV小车激光导航的相对定位方法,包括有AVG小车以及激光雷达,其特征在于,包括有以下步骤:
S1、所述激光雷达扫描周围环境,根据激光雷达所取得的距离以及角度信息获得周围环境的边界图形;
S2、建立AVG小车在边界图形内的局部直角坐标系;
S3、获得边界图形的重心点,将重心点记为P(X,Y);
S4、获得边界图形对于重心点的惯量矩阵,获得相邻时刻下AGV小车所在位置的方向角变化量;
S5、将后一时刻的AGV小车正方向旋转到与前一时刻AGV小车正方向一致;
S6、获得旋转后一时刻边界图形的重心位置坐标,然后将两相邻时刻的重心位置坐标相减就即可得到两相邻时刻的相对位移。
2.根据权利要求1所述的相对定位方法,其特征在于,其中所述S2中建立如下的局部直角坐标系,
Figure FDA0002555343720000011
其中,l为激光雷达到边界图形之间的距离,θ为对应的角度信息。
3.根据权利要求1所述的相对定位方法,其特征在于,其中所述S3中获得边界图形的重心点的具体步骤包括有:
A1、在边界图形内任取一确定的空间直角坐标系O-xy,则边界图形可微元出i个质点,
每个质点对应各自坐标(xi,yi)及质量mi
A2、令M=m1+m2+…+mi,该边界图形的重心为P(X,Y);
则有:X=(x1m1+x2m2+…+ximi)/M;Y=(y1m1+y2m2+…+yimi)/M;
A3、其中O点为激光雷达所在位置,A点为其中一个扫描点,β为角分辨率,θi表示的是第i个点的角度信息,l为激光雷达测得的A点到激光雷达的位置距离,设A′为等腰三角形的重心位置,A′与O点之间的距离为2/3S,则有
Figure FDA0002555343720000012
Figure FDA0002555343720000013
质量权重用三角形的面积来表示:
Figure FDA0002555343720000014
将xi、yi、mi代入所述A2中即可得到重心P的坐标。
4.根据权利要求3所述的相对定位方法,其特征在于,其中,所述S4中惯量矩阵的求取具体包括以下步骤:
B1、将激光雷达扫描得到的边界图形看作刚体,将每个扫描点看作质点,根据转动惯量公式:
Figure FDA0002555343720000021
Figure FDA0002555343720000022
Figure FDA0002555343720000023
其中,(xi,yi)是将坐标系平移到以重心为坐标原点下各点的坐标值并建立参考直角坐标系,可以得到分别绕参考直角坐标系下x轴、y轴的转动惯量;
B2、得到该体系对于重心的惯量矩阵:
Figure FDA0002555343720000024
B3、得到了惯量主轴以及惯量主轴与坐标轴之间的夹角,其中特征向量表示的是长短轴在参考直角坐标系中的方向,得到获得相邻时刻下两个边界图形的相对旋转角度。
5.根据权利要求4所述的相对定位方法,其特征在于,其中所述S6中包括有:所述位移变化量的求取将后一时刻的AGV小车正方向旋转到与前一时刻AGV小车正方向一致,再次根据所述S4求出旋转后后一时刻边界图形的重心位置坐标(X′2,Y′2),然后将后一时刻边界图形的重心位置坐标与S3中得到的前一时刻的重心位置坐标(X1,Y1)相减就可得到两时刻的相对位移Δx=X1-X‘2;Δy=Y1-Y′2
CN202010593878.6A 2020-06-24 2020-06-24 一种用于agv小车激光导航的相对定位方法 Active CN111679292B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010593878.6A CN111679292B (zh) 2020-06-24 2020-06-24 一种用于agv小车激光导航的相对定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010593878.6A CN111679292B (zh) 2020-06-24 2020-06-24 一种用于agv小车激光导航的相对定位方法

Publications (2)

Publication Number Publication Date
CN111679292A true CN111679292A (zh) 2020-09-18
CN111679292B CN111679292B (zh) 2023-04-07

Family

ID=72437344

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010593878.6A Active CN111679292B (zh) 2020-06-24 2020-06-24 一种用于agv小车激光导航的相对定位方法

Country Status (1)

Country Link
CN (1) CN111679292B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109709955A (zh) * 2018-12-24 2019-05-03 芜湖智久机器人有限公司 一种将激光反光板数据与cad坐标系匹配的方法、系统及存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105094134A (zh) * 2015-08-25 2015-11-25 杭州金人自动控制设备有限公司 一种基于图像巡线的agv定点停车方法
US20170121158A1 (en) * 2011-08-26 2017-05-04 Crown Equipment Corporation Systems and methods for pose development using retrieved position of a pallet or product load to be picked up
CN109752725A (zh) * 2019-01-14 2019-05-14 天合光能股份有限公司 一种低速商用机器人、定位导航方法及定位导航系统
WO2019096986A1 (en) * 2017-11-17 2019-05-23 Trinamix Gmbh Detector for determining a position of at least one object
CN110823214A (zh) * 2019-10-18 2020-02-21 西北工业大学 一种空间完全非合作目标相对位姿和惯量估计方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20170121158A1 (en) * 2011-08-26 2017-05-04 Crown Equipment Corporation Systems and methods for pose development using retrieved position of a pallet or product load to be picked up
CN105094134A (zh) * 2015-08-25 2015-11-25 杭州金人自动控制设备有限公司 一种基于图像巡线的agv定点停车方法
WO2019096986A1 (en) * 2017-11-17 2019-05-23 Trinamix Gmbh Detector for determining a position of at least one object
CN109752725A (zh) * 2019-01-14 2019-05-14 天合光能股份有限公司 一种低速商用机器人、定位导航方法及定位导航系统
CN110823214A (zh) * 2019-10-18 2020-02-21 西北工业大学 一种空间完全非合作目标相对位姿和惯量估计方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
THANH LUAN BUI ET AL.: ""Trajectory tracking controller design for AGV using laser sensor based positioning system"", 《2013 9TH ASIAN CONTROL CONFERENCE (ASCC)》 *
王俊祥: ""仓库通道环境下AGV小车定位技术与实现"", 《中国优秀硕士学位论文全文数据库 信息科技辑》 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109709955A (zh) * 2018-12-24 2019-05-03 芜湖智久机器人有限公司 一种将激光反光板数据与cad坐标系匹配的方法、系统及存储介质

Also Published As

Publication number Publication date
CN111679292B (zh) 2023-04-07

Similar Documents

Publication Publication Date Title
CN108012325B (zh) 一种基于uwb和双目视觉的导航定位方法
Peng et al. A pose measurement method of a space noncooperative target based on maximum outer contour recognition
US5677836A (en) Method for producing a cellularly structured environment map of a self-propelled, mobile unit that orients itself in the environment at least with the assistance of sensors based on wave refection
CN106737549B (zh) 一种移动机器人及其防倾覆方法和装置
CN109405835B (zh) 基于非合作目标直线与圆单目图像的相对位姿测量方法
CN108344396B (zh) 一种敏捷卫星斜条带成像模式姿态计算方法
US9218646B1 (en) Distributed path planning for mobile sensors
CN111273312B (zh) 一种智能车辆定位与回环检测方法
CN110873883A (zh) 融合激光雷达和imu的定位方法、介质、终端和装置
CN113028990B (zh) 一种基于加权最小二乘的激光跟踪姿态测量系统及方法
Eynard et al. Real time UAV altitude, attitude and motion estimation from hybrid stereovision
CN112154303B (zh) 高精度地图定位方法、系统、平台及计算机可读存储介质
CN106570905A (zh) 一种非合作目标点云初始姿态验证方法
CN115220012A (zh) 一种基于反光板定位方法
CN113205603A (zh) 一种基于旋转台的三维点云拼接重建方法
CN111679292A (zh) 一种用于agv小车激光导航的相对定位方法
CN113985405A (zh) 障碍物检测方法、应用于车辆的障碍物检测设备
CN111688949A (zh) 一种无人机悬停姿态测量装置及方法
CN108592860B (zh) 用于机载光电观瞄系统基轴对准操作后的瞄准线输出角度计算方法
CN116681733B (zh) 一种空间非合作目标近距离实时位姿跟踪方法
WO2020215296A1 (zh) 可移动平台的巡线控制方法、设备、可移动平台及系统
Pereira et al. Backward motion for estimation enhancement in sparse visual odometry
JPH07152810A (ja) 環境モデル作成装置
CN114184168A (zh) 光测设备实时倾斜补偿方法
Zhang et al. Robot Mapping and Navigation System Based on Multi-sensor Fusion

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
CB02 Change of applicant information

Address after: No. 3 Dingjiabang Road, Dianshan Lake Town, Kunshan City, Suzhou City, Jiangsu Province

Applicant after: Kunshan Tongri Intelligent Technology Co.,Ltd.

Address before: No. 3 Dingjiabang Road, Dianshan Lake Town, Kunshan City, Suzhou City, Jiangsu Province

Applicant before: Kunshan Tongfu Intelligent Technology Co.,Ltd.

CB02 Change of applicant information
GR01 Patent grant
GR01 Patent grant