一种用于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中建立如下的局部直角坐标系，其中，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，则有

质量权重用三角形的面积来表示：

将xi、yi、mi代入所述a2中即可得到重心p的坐标。

本发明进一步设置为：其中，所述s4中惯量矩阵的求取具体包括以下步骤：

b1、将激光雷达扫描得到的边界图形看作刚体，将每个扫描点看作质点，根据转动惯量公式：

其中，(xi，yi)是将坐标系平移到以重心为坐标原点下各点的坐标值并建立参考直角坐标系，可以得到分别绕参考直角坐标系下x轴、y轴的转动惯量；

b2、得到该体系对于重心的惯量矩阵：

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中建立如下的局部直角坐标系：其中，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)……。在实际扫描中两个点之间的角度差θ2-θ1≈角分辨率β为0.15°；l为激光雷达测得的a点到激光雷达的位置距离，设a′为等腰三角形的重心位置，a′与0点之间的距离为2/3s，则有

质量权重用三角形的面积来表示：

将xi、yi、mi代入a2中即可得到重心p的坐标。

结合图5、图6和图7所示，其中，s4中惯量矩阵的求取具体包括以下步骤：

b1、将激光雷达扫描得到的边界图形看作刚体，将每个扫描点看作质点，根据转动惯量公式：

其中，(xi，yi)是将坐标系平移到以重心为坐标原点下各点的坐标值并建立参考直角坐标系，可以得到分别绕参考直角坐标系下x轴、y轴的转动惯量；

参考直角坐标系与局部直角坐标系的关系是：局部直角坐标系的原点是激光雷达，参考直角坐标系的原点是边界图形的中心，两者的x轴平行，y轴平行；

b2、得到该体系对于重心的惯量矩阵：

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)，在求重心坐标的时候公式为：

(质量权重不变)

其中所述s6中包括有：所述位移变化量的求取将后一时刻的agv小车正方向旋转到与前一时刻agv小车正方向一致，再次根据所述s4求出旋转后后一时刻边界图形的重心位置坐标(x‘2，y‘2)，然后将后一时刻边界图形的重心位置坐标与s3中得到的前一时刻的重心位置坐标(x1，y1)相减就可得到两时刻的相对位移δx＝x1-x‘2；δy＝y1-y‘2。

应当指出，对于本领域的普通技术人员来说，在不脱离本发明创造构思的前提下，还可以做出若干变形和改进，这些都属于本发明的保护范围。