工程设计学报, 2022, 29(2): 123-132 doi: 10.3785/j.issn.1006-754X.2022.00.032

设计理论与方法

4WID-4WIS智能车阿克曼转向轨迹规划及位置估算

时培成,,1, 陈旭1, 杨爱喜2, 章亮1

1.安徽工程大学 汽车新技术安徽省工程技术研究中心,安徽 芜湖 241000

2.浙江大学 工程师学院,浙江 杭州 310000

Ackerman steering trajectory planning and position estimation of 4WID-4WIS intelligent vehicle

SHI Pei-cheng,,1, CHEN Xu1, YANG Ai-xi2, ZHANG Liang1

1.Anhui Engineering Technology Research Center of Automotive New Technology,Anhui Polytechnic University,Wuhu 241000,China

2.Polytechnic Institute,Zhejiang University,Hangzhou 310000,China

收稿日期: 2021-07-14   修回日期: 2021-09-15  

基金资助: 国家自然科学基金资助项目.  51575001
安徽省重点研究与开发计划项目.  202104a05020003
安徽省发展和改革委员会支持研发创新类项目.  [2020]479

Received: 2021-07-14   Revised: 2021-09-15  

作者简介 About authors

时培成(1976—),男,安徽六安人,教授,博士,从事智能网联汽车、汽车/机械系统动力学等研究,E-mail:shipeicheng@126.comhttps://orcid.org/0000-0003-1533-8154 , E-mail:shipeicheng@126.com

摘要

针对四轮独立驱动与四轮独立转向(four-wheel independent drive and four-wheel independent steering, 4WID-4WIS)智能车的转向行驶工况,基于阿克曼转向原理,提出一种利用三阶贝塞尔曲线进行轨迹规划的新方法。首先,采用最优函数获取一条满足智能车初始状态约束、目标状态约束和曲率连续约束且曲率差值最小的最优轨迹。然后,提出一种位置估算算法,即基于惯性导航系统测量的航向角和编码器的脉冲数对智能车的位置增量进行计算,从而估算其行驶时的位置,并推算运行轨迹的长度。最后,在MATLAB软件中对所规划的智能车轨迹进行仿真计算,并在实车试验平台上验证轨迹规划方法和位置估算算法的合理性和可行性。结果表明,4WID-4WIS智能车能够按规划的轨迹行驶到给定终点,其横向位置估算误差为0.19%,纵向位置估算误差为0.20%,运行轨迹长度推算误差为0.22%;相比于其他里程计算法、测距法等单一算法,所提出的位置估算算法的精度高,可为其他移动机器人的轨迹规划和位置估算提供参考。

关键词: 四轮独立驱动与四轮独立转向(4WID-4WIS) ; 阿克曼转向 ; 贝塞尔曲线 ; 轨迹规划

Abstract

Aiming at the steering driving conditions of four-wheel independent drive and four-wheel independent steering (4WID-4WIS) intelligent vehicles, a new method for trajectory planning using third-order Bézier curve was proposed based on the Ackerman steering principle. Firstly, an optimal trajectory with minimum curvature difference was obtained by using the optimal function, which met the initial state constraints and target state constraints of intelligent vehicle and the curvature continuity constraints. Then, a position estimation algorithm was proposed, which calculated the position increment of intelligent vehicle based on the navigation angle measured by the inertial navigation system and the pulse number of encoder, so as to estimate its position during driving and calculate the driving trajectory length. Finally, the planned intelligent vehicle trajectory was simulated in the MATLAB software, and the rationality and feasibility of the trajectory planning method and position estimation algorithm were verified on the real vehicle test platform. The results showed that the 4WID-4WIS intelligent vehicle could drive to the given end point according to the planned trajectory, and its lateral position estimation error was 0.19%, the longitudinal position estimation error was 0.20% and the driving trajectory length calculation error was 0.22%; compared with other single algorithms such as mileage calculation method and ranging method, the proposed position estimation algorithm had high precision, which can provide reference for trajectory planning and position estimation of other mobile robots.

Keywords: four-wheel independent drive and four-wheel independent steering (4WID-4WIS) ; Ackerman steering ; Bézier curve ; trajectory planning

PDF (3293KB) 元数据 多维度评价 相关文章 导出 EndNote| Ris| Bibtex  收藏本文

本文引用格式

时培成, 陈旭, 杨爱喜, 章亮. 4WID-4WIS智能车阿克曼转向轨迹规划及位置估算. 工程设计学报[J], 2022, 29(2): 123-132 doi:10.3785/j.issn.1006-754X.2022.00.032

SHI Pei-cheng, CHEN Xu, YANG Ai-xi, ZHANG Liang. Ackerman steering trajectory planning and position estimation of 4WID-4WIS intelligent vehicle. Chinese Journal of Engineering Design[J], 2022, 29(2): 123-132 doi:10.3785/j.issn.1006-754X.2022.00.032

轨迹规划是智能车的基本功能之一,其目的是通过传感器感知周围环境并利用主动避障功能找到一条从起点到终点的最佳路径1。根据环境条件的不同,轨迹规划方法分为全局规划方法和局部规划方法。常用的全局规划方法有A*算法2、Dijkstra(狄克斯特拉)算法3和蚁群算法4等;常用的局部规划方法有多项式曲线法5、人工势场法6、贝塞尔曲线法7和B样条曲线法8等。其中,贝塞尔曲线具有曲率连续的优点,只需要确定控制点的坐标即可获得最优轨迹,其计算量较小,从而得到了广泛应用。张新锋等9基于贝塞尔曲线对智能商用车的换道避障轨迹进行了规划,并利用遗传算法选取最优避障路径,但是其在路径寻优中并未考虑遗传算法对参数寻优的随机性,且没有通过实车验证。陈成等10基于四阶贝塞尔曲线探讨了无人车轨迹规划的可行性,并推导了相应的曲率约束条件,同时利用序列二次规划(sequential quadratic programming, SQP)算法选取最优轨迹,但其在轨迹规划中对车辆的动力学约束不足。Jolly等11利用三阶贝塞尔曲线对机器人的轨迹规划问题进行了研究,但其提出的规划方法仅考虑了加速度约束,并未考虑曲率约束。高嵩等12针对无人车局部避障问题,基于贝塞尔曲线对无人车的避障路径进行了规划,其通过最小化曲线的曲率差值来选取曲线的控制点,并利用SQP算法选取最优避障路径,同时结合实际道路情况进行了避障仿真实验,但是其在规划避障路径时并未考虑无人车的速度规划问题,在仿真实验时也没有考虑整车实际行驶情况对避障路径的影响。

基于此,笔者针对四轮独立驱动与四轮独立转向(four-wheel independent drive and four-wheel independent steering, 4WID-4WIS)智能车的转向行驶工况,在已知起点位置的情况下,给定终点位置和行驶方向,利用三阶贝塞尔曲线规划一系列轨迹,并采用优化函数获取满足智能车初始状态约束、目标状态约束和曲率连续约束且曲率差值最小的最优轨迹,使智能车按最优轨迹从起点移动到终点并保持给定的航向角。同时,提出一种位置估算算法,将轨迹微元近似(即将轨迹无限细分),以直线轨迹代替曲线轨迹,并利用惯性导航系统测量的航向角和编码器的脉冲数对智能车的位置进行估算。

1 基于三阶贝塞尔曲线的智能车轨迹规划

1.1 三阶贝塞尔曲线

贝塞尔曲线是法国工程师Bézier提出的一种适用于二维图形应用程序的数学曲线13。贝塞尔曲线由一组控制点确定:将给定的控制点按顺序连接构成多边形,通过调整控制点的坐标来改变贝塞尔曲线的形状,使曲线不断逼近该多边形。对于由n+1个控制点P0P1P2Pn(其位置矢量分别为P0P1P2Pn)确定的贝塞尔曲线,定义为:

p(t)=i=0nCni(1-t)n-itiPi=i=0nB(i, n)(t)Pi, t0, 1

式中:B(i,n)(t)为伯恩斯坦基函数14t为比例,其决定了贝塞尔曲线组成点的数量。

鉴于本文基于三阶贝塞尔曲线对4WID-4WIS智能车的阿克曼转向轨迹进行规划,则仅对该曲线的相关特性进行介绍。图1所示为由4个控制点P0P1P2P3唯一确定的三阶贝塞尔曲线,依次连接4个控制点可得到3条一阶贝塞尔曲线,分别为P0P1P1P2P2P3

图1

图1   三阶贝塞尔曲线示意

Fig.1   Schematic diagram of third-order Bézier curve


三阶贝塞尔曲线的性质15如下:

1)曲线的参数化表达式为:

p(t)=P0(1-t)3+3P1(1-t)2t+    3P2(1-t)t2+P3t3, t0, 1

2)曲线经过两端的控制点:

p(0)=P0p(1)=P3

3)起点和终点分别为曲线两端的切点,切向量为:

p'(0)=3(P1-P0)p'(1)=3(P3-P2)

1.2 轨迹规划

针对 4WID-4WIS智能车在阿克曼转向工况下进行曲线行驶时,已知起点A,即第1个控制点P0的坐标为(X0,Y0,β0),其中X0Y0分别为起点A的横、纵坐标,β0为起点A处的航向角;终点B,即第4个控制点P3的坐标为(X3,Y3,β3),各变量的含义同上。基于三阶贝塞尔曲线规划轨迹,使智能车从起点A移动到指定的终点B,规划的轨迹如图2所示。

图2

图2   基于三阶贝塞尔曲线的智能车轨迹规划示意

Fig.2   Schematic diagram of intelligent vehicle trajectory planning based on third-order Bézier curve


根据三阶贝塞尔曲线的定义可知,该规划轨迹由3条一阶贝塞尔曲线和4个控制点确定,第1条一阶贝塞尔曲线为控制点P0P1的连线P0P1,第2条一阶贝塞尔曲线为控制点P1P2的连线P1P2,第3条一阶贝塞尔曲线为控制点P2P3的连线P2P3。延长P0P1P2P3相交于O点,则控制点P1可以取直线AO上的任意一点,但不与A点和O点重合;控制点P2可以取直线BO上的任意一点,但不与B点和O点重合。

由控制点P0的坐标可得,第1条一阶贝塞尔曲线P0P1的方程为:

yP0P1=tanβ0x+Y0-tanβ0X0

由控制点P3的坐标可得,第3条一阶贝塞尔曲线P2P3的方程为:

yP2P3=tanβ3x+Y3-tanβ3X3
联立式(2)和式(3)可得,一阶贝塞尔曲线P0P1P2P3的交点O的横、纵坐标XOYO分别为:XO=Y3-Y0+tanβ0X0-tanβ3X3tanβ0-tanβ3YO=Y3tanβ0-Y0tanβ3+tanβ3tanβ3(X0-X3)tanβ0-tanβ3

由此可得,控制点P1的横、纵坐标X1Y1的取值范围为:

X1(X0, XO)Y1(Y0, YO)

控制点P2的横、纵坐标X2Y2的取值范围为:

X2(XO, X3)Y2(YO, Y3)

通过以上方法,固定三阶贝塞尔曲线的控制点P0P3,在直线AOBO上分别选择2个点作为控制点P1P2,即可获得满足智能车初始状态约束、目标状态约束以及曲率连续约束的一系列轨迹。

1.3 轨迹优化求解

本文采用最优函数来求解满足上述约束条件的最优参数,从而获得最优轨迹。所构建的优化函数为J(P1, P2)

J(P1, P2)=kmax(t1)-kmin(t2),  t1, t2(0,1)

式中:t1t2分别为三阶贝塞尔曲线达到最大曲率与最小曲率时t的取值。

函数JP1P2)的含义为:通过优化控制点P1P2来使所规划轨迹的最大曲率与最小曲率的差值最小,即其曲率变化最小,从而使轨迹更加平滑,以便车辆平顺、稳定地行驶16

2 智能车轨迹规划仿真验证

在4WID-4WIS智能车阿克曼转向轨迹规划中,首先要确定其初始位姿和目标位姿,然后根据上文方法进行轨迹规划,最后在所规划的一系列轨迹中选择1条最为平滑的轨迹,即最优轨迹。本文以4WID-4WIS智能车的初始位置为坐标系原点,此时航向角为0°,即车身与x轴平行,则其初始位姿为(0 m, 0 m, 0°);目标位置的坐标为(20, 30)m,航向角为90°,即车身与y轴平行,则目标位姿为(20 m, 30 m, 90°);所规划轨迹由200个点组成。通过在MATLAB软件中编程规划得到从起点(0,0) m到终点(20,30) m的一系列轨迹,并在这些轨迹中选择最大曲率与最小曲率差值最小的一条轨迹作为最优轨迹。

1)给定控制点P1坐标,控制点P2坐标寻优。

固定控制点P1的坐标,由智能车在起点处的航向角为0°可确定P1的坐标为(10,0) m;由智能车在终点处的航向角为90°可确定控制点P2的横坐标为20 m。通过改变P2的纵坐标规划得到30条不同的轨迹,结果如图3所示。其中:图3(a)所示为规划得到的30条轨迹;图3(b)所示为每条规划轨迹的最大曲率与最小曲率的差值变化情况;图3(c)所示为最优轨迹,即第9条规划轨迹。

图3

图3   改变控制点P2所得的4WID-4WIS智能车轨迹规划仿真结果

Fig.3   Trajectory planning simulation results of 4WID-4WIS intelligent vehicle obtained by changing control point P2


图3可以得出,第9条规划轨迹的最大曲率与最小曲率的差值最小,为0.046 3,则该轨迹即为最优轨迹,此时控制点P2的纵坐标为8 m。由此可得,4个控制点P0P1P2P3的坐标分别为(0,0),(10,0),(20,9)(20,30) m。

2)给定控制点P2坐标,控制点P1坐标寻优。

固定控制点P2的坐标,由智能车在终点处的航向角为90°可确定控制点P2的坐标为(20,15) m;由智能车在起点处的航向角为0°可知,控制点P1的纵坐标为0 m。通过改变P1的横坐标规划得到20条不同的轨迹,结果如图4所示。其中:图4(a)所示为规划得到的20条轨迹;图4(b)所示为每条轨迹的最大曲率与最小曲率的差值变化情况;图4(c)所示为最优轨迹,即第13条轨迹。

图4

图4   改变控制点P1所得的4WID-4WIS智能车轨迹规划仿真结果

Fig.4   Trajectory planning simulation results of 4WID-4WIS intelligent vehicle obtained by changing control point P1


图4可以得出,第13条规划轨迹的最大曲率与最小曲率的差值最小,为0.045 6,则该轨迹即为最优轨迹,此时控制点P1的横坐标为13 m。由此可得,4个控制点P0P1P2P3的坐标分别为(0,0),(13,0),(20,15)(20,30) m。

3)控制点P1P2坐标同时寻优。

由上述结果可知,仅改变控制点P1P2的坐标,无法真正得到最优轨迹,这是因为只改变一个点的坐标有可能会漏掉曲率差值真正最小的曲线。因此,应按照上文所述方法,通过同时改变控制点P1的横坐标和控制点P2的纵坐标来寻找真正的最优轨迹。通过同时改变控制点P1P2的坐标规划得到600条不同的轨迹,结果如图5所示。其中:图5(a)所示为规划得到的600条轨迹;图5(b)所示为每条规划轨迹的最大曲率与最小曲率的差值变化情况;图5(c)所示为最优轨迹,即第406条轨迹。

图5

图5   同时改变控制点P1P2所得的4WID-4WIS智能车轨迹规划仿真结果

Fig.5   Simulation results of trajectory planning of 4WID-4WIS intelligent vehicle obtained by changing control point P1 and P2 at the same time


图5可以得出,第406条规划轨迹的最大曲率与最小曲率的差值最小,为0.045 2,则该轨迹即为最优轨迹,此时控制点P1的横坐标为13 m,控制点P2的纵坐标为16 m。由此可得,4个控制点P0P1P2P3的坐标分别为(0,0)(13,0)(20,16)(20,30) m。

基于不同寻优方式获得的智能车最优轨迹控制点的仿真结果如表1所示。由表中数据可知,仅对控制点P1的横坐标或控制点P2的纵坐标进行寻优,无法获得曲率差值真正最小的最优轨迹,须同时对控制点P1的横坐标和控制点P2的纵坐标进行寻优,才能得到满足约束条件的最优轨迹。

表1   4WID-4WIS智能车最优轨迹控制点仿真结果对比

Table 1  Comparison of simulation results of optimal trajectory control points of 4WID-4WIS intelligent vehicle

寻优方式曲率差值4个控制点的坐标/m
P2纵坐标寻优0.046 3

(0, 0),(10, 0),

(20, 9),(20, 30)

P1横坐标寻优0.045 6

(0, 0),(13, 0),

(20, 15),(20, 30)

P1P2坐标同时寻优0.045 2

(0, 0),(13, 0),

(20, 16),(20, 30)

新窗口打开| 下载CSV


3 智能车位置估算算法

3.1 算法简介

在智能车运行时,需要对其位置进行估算,以便实时掌握其运行姿态。常用定位算法通常采用惯性导航系统和编码器来测量数据。如:文献[17]针对轮式机器人,提出了一种改进的轨迹推算方法,即通过编码器测定2个同轴驱动轮的速度,从而建立一种新的轨迹推算理论模型,以尽可能去除外部干扰,提高定位精度,但该方法只是改变了推算模型,并未解决使用单一编码器误差较大的问题。文献[18]通过测量差动驱动机器人的2个同轴驱动轮的角速度,并利用其差动驱动系统的运动规律推算驱动轮在下一个采样时刻的位置,但该方法仅仅在理论上进行了推导,并未通过机器人的实际行驶情况来验证理论模型的正确性。为此,笔者提出了一种基于惯性导航系统和编码器的4WID-4WIS智能车位置估算算法。首先,在根据比例t划分的每小段轨迹内,通过惯性导航系统测量获得智能车航向角的变化量,并利用编码器记录4个驱动电机的脉冲数,根据航向角的变化量和编码器的脉冲数来计算智能车中心点的转弯半径;然后,根据中心点转弯半径和航向角变化量,计算该段轨迹内智能车的转向弧长;最后,将转向弧线分段近似为线段,并计算各段轨迹的长度,同时根据各段轨迹的长度和航向角的变化量,计算智能车的位置增量,实现其位置估算。

3.2 阿克曼转向模型

4WID-4WIS智能车的阿克曼转向模型(左转)如图6所示。图中:为整车转向中心,D为左、右侧驱动轮轮距,W为前后驱动轮轴距,R为整车中心点转弯半径,R1为左侧驱动轮转弯半径,Rr为右侧驱动轮转弯半径,δl为左侧驱动轮转角,δr为右侧驱动轮转角。

图6

图6   4WID-4WIS智能车的阿克曼转向模型

Fig.6   Ackerman steering model of 4WID-4WIS intelligent vehicle


当4WID-4WIS智能车运行时,利用其驱动轮上编码器的脉冲数和惯性导航系统测量的航向角来估算其位姿。设编码器旋转一周的脉冲数为N,在每小段轨迹内,惯性导航系统测量得到的航向角变化量为dθ,编码器的脉冲数为M,则有:

ηl1=2πMl1Nηl2=2πMl2Nηr1=2πMr1Nηr1=2πMr1N

式中:ηl1ηl2ηr1ηr1为智能车运行时左、右侧前后驱动轮的滚动角度; Ml1Ml2Mr1Mr1为左、右侧前后驱动轮上编码器的脉冲数。

由左、右侧前后2个驱动轮的转弯半径相同可知:

ηl1=ηl2  ηr1=ηr2
Ml1=Ml2Mr1=Mr2

在实际运行过程中,因驱动轮的加工材质不完全相同导致不同驱动轮与地面的摩擦不同19,以及硬件上的干扰信号导致编码器返回值受影响等因素,同侧驱动轮上编码器的脉冲数也可能不同。为了防止因驱动轮打滑而造成的编码器脉冲数的增加,本文取同侧编码器中较小的脉冲数,同时在运行过程中观察脉冲数的变化,若发现脉冲数增加明显,则说明侧滑现象严重,应重新进行分析。

由此可得,左、右侧驱动轮的行驶距离SlSr分别为:

Sl=ηlRwheel
Sr=ηrRwheel

式中:ηlηr为左、右侧驱动轮的滚动角度;Rwheel为驱动轮半径。

则左、右侧驱动轮的转弯半径RlRr分别为:

Rl=Sldθ
Rr=Srdθ

基于左、右侧驱动轮转弯半径计算得到的整车中心点转弯半径R1R2,分别为:

R1=Rlδl
R2=Rlδr

由于存在不可抗力的影响因素,基于左、右侧驱动轮转弯半径求得的整车中心点转弯半径可能不同,本文取二者的平均值,即:

R=(R1+R2)2

3.3 位置增量计算

对于轮式智能车来说,传统的轨迹推算过程是将曲线路径进行微元近似,即把曲线无限细分,并将每一小段路径近似成线段进行计算,所有线段距离加和值即为拟合的曲线长度20,其原理如图7所示。

图7

图7   4WID-4WIS智能车轨迹推算原理

Fig.7   Calculation principle of trajectory of 4WID-4WIS intelligent vehicle


图7所示,假设4WID-4WIS智能车沿着圆弧形轨迹从起点A1(x1,y1,θ1)运行到终点A2(x2,y2,θ2),其中θ1θ2分别为智能车在点A1A2处的航向角,dθ为点A2相对于点A1的航向角变化量,即:

dθ=θ2-θ1

根据智能车中心点转弯半径和该段轨迹内航向角的变化量,计算得到该段轨迹的长度lA1A2为:

lA1A2=Rdθ

将长度为lA1A2的圆弧近似为长度为L的线段进行计算,由图7可得:

Δx=Lcosdθ2Δy=Lsindθ2

则可推算出终点A2处智能车的位姿为:

x2y2θ2=x1+Lcosdθ2y1+Lsindθ2     θ1+dθ

4 试验验证

为了验证所提出的轨迹规划方法以及位置估算算法的可行性,在实车试验平台开展相关试验。试验中4WID-4WIS智能车的初始位姿和目标位姿与仿真时一致,即分别为(0 m, 0 m, 0°)和(20 m, 30 m, 90°)。同时,为了避免智能车运行时四轮驱动和四轮转向相互干涉影响,在硬件设计上,设置主控制板通过控制器局域网(controller area network, CAN)与电机驱动器进行通信:通过CANA与驱动电机驱动器通信,通过CANB与转向电机驱动器通信,以保证驱动和转向在控制上相互独立。在软件设计上,驱动电机在速度环、电流环模式下工作,主控制板通过发送目标速度、电流来控制驱动电机;转向电机在位置环模式下工作,主控制板通过发送目标位置来控制转向电机,以避免驱动和转向在工作时相互影响。试验用4WID-4WIS智能车实物如图8所示。

图8

图8   4WID-4WIS智能车实物

Fig.8   Physical object of 4WID-4WIS intelligent vehicle


试验用4WID-4WIS智能车采用DSP28335芯片作为主控芯片,惯性导航系统为格纳微公司生产的GNW-SurPass-A100航姿参考系统,驱动电机(实车上为轮毂电机)编码器为增量式编码器。该智能车的具体参数如表2所示。

表2   4WID-4WIS智能车的参数

Table 2  Parameters of 4WID-4WIS intelligent vehicle

参数数值
前、后驱动轮轴距W/m0.580
左、右侧驱动轮轮距D/m0.498
轮毂电机半径/m0.233
编码器旋转一周的脉冲数N4 096
惯性导航系统精度/(°)0.05

新窗口打开| 下载CSV


在起点处对4WID-4WIS智能车发送目标位姿指令,其主控制器根据轨迹规划算法选取最优轨迹并控制智能车根据规划轨迹从起点运行到终点。在运行过程中,利用惯性导航系统测量智能车的航向角变化量,并读取增量式编码器的脉冲数,试验数据如图9所示。

图9

图9   4WID-4WIS智能车运行过程中的航向角和脉冲数

Fig.9   Navigation angle and pulse number of 4WID-4WIS intelligent vehicle during driving


图9(a)可知,4WID-4WIS智能车在初始位置处保持设定的航向角0°,在按照规划轨迹运行时,其航向角不断变化,到达目标位置时,由于地面摩擦力以及轮胎打滑等因素的影响,其最终的航向角为89.876°,与给定航向角90°的误差为0.13%。由图9(b)可知,在划分的每段轨迹内,脉冲数越多,说明智能车的运行轨迹长度越长;脉冲数越少,说明智能车的运行轨迹长度越短。根据编码器的总脉冲数(本实验中为110 050),即可推算智能车的总运行轨迹长度。

根据4WID-4WIS智能车运行时惯性导航系统测量的航向角以及编码器的脉冲数,利用所提出的位置估算算法对智能车轨迹进行推算,并与规划规迹进行对比,结果如图10所示。

图10

图10   4WID-4WIS智能车轨迹推算结果

Fig.10   Calculation results of trajectory of 4WID-4WIS intelligent vehicle


图10(a)和图10(b)可得,估算得到的终点坐标为(19.962, 29.941) m,与给定的终点坐标(20, 30) m相比,横向位置的相对误差为0.19%,纵向位置的相对误差为0.20%。由图10(c)可以看出,推算轨迹与规划轨迹基本吻合,通过计算得到推算轨迹的长度为39.698 m,与规划轨迹长度39.785 m的相对误差为0.22%

5 结 语

本文针对4WID-4WIS智能车的转向行驶工况,做了以下研究。

1)基于阿克曼转向原理,利用三阶贝塞尔曲线对智能车进行轨迹规划,并利用最优函数选取最优轨迹,使得规划轨迹的最大曲率和最小曲率差值最小,满足初始状态约束、目标状态约束以及曲率连续约束,实现智能车按规划轨迹平滑行驶。

2)提出一种新的位置估算算法,综合利用惯性导航系统和编码器来估算智能车行驶时的位置,并对其轨迹进行推算。试验结果表明,智能车可以按照规划轨迹行驶到指定终点,且横向位置估算误差为0.19%,纵向位置估算误差为0.20%,运行轨迹长度推算误差为0.22%

结果表明,所提出的轨迹规划方法和位置估算算法可为其他移动机器人等的轨迹规划和位置估算提供一定的参考。

参考文献

朱大奇颜明重.

移动机器人路径规划技术综述

[J].控制与决策,2010257):961-967. doi:10.13195/j.cd.2010.07.4.zhudq.014

[本文引用: 1]

ZHU Da-qiYAN Ming-zhong.

Survey on technology of mobile robot path planning

[J]. Control and Decision, 2010257): 961-967.

DOI:10.13195/j.cd.2010.07.4.zhudq.014      [本文引用: 1]

陈靖辉崔岩刘兴林.

基于改进A*算法的移动机器人路径规划方法

[J].计算机应用研究,202037S1):118-119.

[本文引用: 1]

CHEN Jing-huiCUI YanLIU Xing-linet al.

Path planning method for mobile robot based on improved A* algorithms

[J]. Application Research of Computers, 202037S1): 118-119.

[本文引用: 1]

孙文彬谭正龙王江.

基于多粒度通讯的Dijkstra并行算法优化

[J].中国矿业大学学报,2014435):938-943. doi:10.13247/j.cnki.jcumt.000226

[本文引用: 1]

SUN Wen-binTAN Zheng-longWANG Jianget al.

A parallel Dijkstra algorithm based on multi-granularity communication

[J]. Journal of China University of Mining & Technology, 2014435): 938-943.

DOI:10.13247/j.cnki.jcumt.000226      [本文引用: 1]

LAMINI CBENHLIMA LELBEKRI A.

Genetic algorithm based approach for autonomous mobile robot path planning

[J]. Procedia Computer Science, 2018127180-189. doi:10.1016/j.procs.2018.01.113

[本文引用: 1]

马喜峰张雷.

基于对称极多项式曲线的移动机器人平滑路径生成

[J].机器人,2005275):450-454459. doi:10.3321/j.issn:1002-0446.2005.05.015

[本文引用: 1]

MA Xi-fengZHANG Lei.

Smooth path generation for mobile robots based on symmetrical polar polynomials

[J]. Robot, 2005275): 450-454 459.

DOI:10.3321/j.issn:1002-0446.2005.05.015      [本文引用: 1]

罗强王海宝崔小劲.

改进人工势场法自主移动机器人路径规划

[J].控制工程,2019266):1091-1098. doi:10.14107/j.cnki.kzgc.170907

[本文引用: 1]

LUO QiangWANG Hai-baoCUI Xiao-jinet al.

Autonomous mobile robot path planning based on improved artificial potential method

[J]. Control Engineering of China, 2019266): 1091-1098.

DOI:10.14107/j.cnki.kzgc.170907      [本文引用: 1]

ELHOSENY MTHARWAT AHASSANIEN A E.

Curve based path planning in a dynamic field using modified genetic algorithm

[J]. Journal of Computational Science, 201825339-350. doi:10.1016/j.jocs.2017.08.004

[本文引用: 1]

郑天江李俊杰陈庆盈.

基于三次B样条的移动机器人实时轨迹规划研究

[J].制造业自动化,2017395):4-7. doi:10.3969/j.issn.1009-0134.2017.05.002

[本文引用: 1]

ZHENG Tian-jiangLI Jun-jieCHEN Qing-yinget al.

A study of robot motion controller based on pure network

[J]. Manufacturing Automation, 2017395): 4-7.

DOI:10.3969/j.issn.1009-0134.2017.05.002      [本文引用: 1]

张新峰陈建伟左思.

基于贝塞尔曲线的智能商用车换道避障轨迹规划

[J].科学技术与工程,20202029):12150-12157. doi:10.3969/j.issn.1671-1815.2020.29.048

[本文引用: 1]

ZHANG Xin-fengCHEN Jian-weiZUO Si.

Trajectory planning for intelligent commercial vehicle obstacle avoidance based on quartic Bézier curve

[J]. Science Technology and Engineering, 20202029): 12150-12157.

DOI:10.3969/j.issn.1671-1815.2020.29.048      [本文引用: 1]

陈成何玉庆卜春光.

基于四阶贝塞尔曲线的无人车可行轨迹规划

[J].自动化学报,2015413):486-496. doi:10.16383/j.aas.2015.c140295

[本文引用: 1]

CHEN ChengHE Yu-qingBU Chun-guanget al.

Feasible trajectory generation for autonomous vehicles based on quartic Bézier curve

[J]. Acta Automatica Sinica, 2015413): 486-496.

DOI:10.16383/j.aas.2015.c140295      [本文引用: 1]

JOLLY K GKUMAR S RVIJAYAKUMAR R.

A Bezier curve based path planning in a multi-agent robot soccer system without violating the acceleration limits

[J]. Robotics and Autonomous Systems, 2009571): 23-33. doi:10.1016/j.robot.2008.03.009

[本文引用: 1]

高嵩张金炜戎辉.

基于贝塞尔曲线的无人车局部避障应用

[J].现代电子技术,2019429):163-166. Doi:10.16652/j.issn.1004-373x.2019.09.038

[本文引用: 1]

GAO SongZHANG Jin-weiRONG Huiet al.

Application of unmanned vehicle local obstacle avoidance method based on Bezier curve

[J]. Modern Electronics Technique, 2019429): 163-166.

DOI:10.16652/j.issn.1004-373x.2019.09.038      [本文引用: 1]

刘学问陶钧徐海巍.

基于三阶贝塞尔曲线的AGV轨迹规划研究

[J].工业控制计算机,2018311):113-114. doi:10.3969/j.issn.1001-182X.2018.01.047

[本文引用: 1]

LIU Xue-wenTAO JunXU Hai-wei.

Feasible trajectory generation for AGV based on cubic Bézier curve

[J]. Industrial Control Computer, 2018311): 113-114.

DOI:10.3969/j.issn.1001-182X.2018.01.047      [本文引用: 1]

刘望城王留召.

基于贝塞尔曲线法线的太阳圆心求取方法

[J].测绘与空间地理信息,2021447):189-192201. doi:10.3969/j.issn.1672-5867.2021.07.049

[本文引用: 1]

LIU Wang-chengWANG Liu-zhao.

Method to calculate the center of the sun based on the normal lines of the Bézier curve

[J]. Geomatics & Spatial Information Technology, 2021447): 189-192 201.

DOI:10.3969/j.issn.1672-5867.2021.07.049      [本文引用: 1]

崔根群胡可润唐风敏.

融合遗传贝塞尔曲线的智能汽车路径规划

[J].现代电子技术,2021441):144-148. doi:10.16652/j.issn.1004-373x.2021.01.030

[本文引用: 1]

CUI Gen-qunHU Ke-runTANG Feng-min.

Intelligent vehicle path planning based on genetic algorithm and Bézier curve

[J]. Modern Electronics Technique, 2021441): 144-148.

DOI:10.16652/j.issn.1004-373x.2021.01.030      [本文引用: 1]

郑亮孙龙龙陈双.

一种改进工业自动导引车路径规划算法

[J].科学技术与工程,20212116):6758-6763. doi:10.3969/j.issn.1671-1815.2021.16.033

[本文引用: 1]

ZHENG LiangSUN Long-longCHEN Shuang.

An improved industrial automated guided vehicle path planning algorithm

[J]. Science Technology and Engineering, 20212116): 6758-6763.

DOI:10.3969/j.issn.1671-1815.2021.16.033      [本文引用: 1]

向秀娟袁亮姜道伟.

双轮差速驱动式室内移动机器人的改进航迹推算方法

[J].机床与液压,20164411):8-1123. doi:10.3969/j.issn.1001-3881.2016.11.002

[本文引用: 1]

XIANG Xiu-juanYUAN LiangJIANG Dao-wei.

Improved dead reckoning method for two-wheel differential driving interior mobile robot

[J]. Machine Tool & Hydraulics, 20164411): 8-11 23.

DOI:10.3969/j.issn.1001-3881.2016.11.002      [本文引用: 1]

张利潘承毅刘征宇.

差动驱动机器人的一种航迹推算定位方法

[J].合肥工业大学学报,20103311):1605-16081622. doi:10.3969/j.issn.1003-5060.2010.11.002

[本文引用: 1]

ZHANG LiPAN Cheng-yiLIU Zheng-yuet al.

A new method of dead reckoning for differential drive mobile robots

[J]. Journal of Hefei University of Technology, 20103311): 1605-1608 1622.

DOI:10.3969/j.issn.1003-5060.2010.11.002      [本文引用: 1]

李雪茹王禹林欧屹.

三轮全向移动机器人的航迹推算定位方法

[J].兵工自动化,2017365):62-65. doi:10.7690/bgzdh.2017.05.017

[本文引用: 1]

LI Xue-ruWANG Yu-linYi OUet al.

Dead reckoning positioning method of 3 wheels omnidirectional mobile robot

[J]. Ordnance Industry Automation, 2017365): 62-65.

DOI:10.7690/bgzdh.2017.05.017      [本文引用: 1]

周婧陈庙红吴豪杰.

基于惯性导航的平面航迹推算的研究

[J].计算机科学,2017446A):582-586. doi:10.11896/j.issn.1002-137X.2017.6A.131

[本文引用: 1]

ZHOU JingCHEN Miao-hongWU Hao-jie.

Research on plane dead reckoning based on intertial navigation system

[J]. Computer Science, 2017446A): 582-586.

DOI:10.11896/j.issn.1002-137X.2017.6A.131      [本文引用: 1]

/