1.一种AGV智能车的轨迹信息处理控制方法,包括如下步骤:
(1)获取AGV智能车在图像中的轨迹信息,对所述轨迹信息进行分段拟合,得到多组依次连接的线段;
(2)对于任一组线段,提取该线段的斜率slope以及线段上每个点相对图像Y轴的偏移量,进而通过坐标变换计算每组线段的决策量;
(3)根据每组线段的决策量通过衰减求和计算得到整个轨迹的决策量,进而根据该决策量结合车辆方向盘角度与转弯半径关系,决策出AGV智能车的转向角度和速度并发送给VCU,由VCU对AGV智能车的行进执行控制。
2.根据权利要求1所述的轨迹信息处理控制方法,其特征在于:所述步骤(1)中对轨迹信息进行分段拟合的过程为:首先根据车辆长度、行进速度以及轨迹长度确定分段步长,依据分段步长对整个轨迹信息进行分段;然后利用最小二乘法将每段轨迹信息拟合成线段。
3.根据权利要求1所述的轨迹信息处理控制方法,其特征在于:所述步骤(2)中通过坐标变换计算每组线段决策量的具体过程如下:
2.1对线段的斜率slope进行坐标变换:
若slope≥0,则坐标变换后线段的斜率slope'=1-2actan(slope)/π;
若slope<0,则坐标变换后线段的斜率slope'=-1-2actan(slope)/π;
2.2通过以下公式计算坐标变换后线段的偏移量X':
X'=2Xaverage/width-1
其中:actan()为反正切函数,Xaverage为线段上所有点相对图像Y轴的平均偏移量,width为图像的宽度;
2.3根据斜率slope'以及偏移量X'通过加权求和得到线段的决策量。
4.根据权利要求1所述的轨迹信息处理控制方法,其特征在于:所述步骤(3)中通过衰减求和计算整个轨迹决策量的具体过程如下:
首先,根据图像中各线段与AGV智能车的远近关系,对所有线段的决策量进行排序,由近及远依次为A1,A2,A3,…,An;
然后,根据以下公式计算出整个轨迹的决策量A:
A=A1+αA2+α2A3+…+αn-1An
其中,n为线段的数量,α为设定的衰减系数且0<α<1。
5.根据权利要求1所述的轨迹信息处理控制方法,其特征在于:所述步骤(3)中当决策出AGV智能车的转向角度和速度后通过约定好的通信协议以指令的形式发送到VCU,由VCU采用增量式PID控制算法对AGV智能车的行进执行控制。