CN107272707B - 基于ipv6的无人车自动轨迹模糊pid跟随控制方法 - Google Patents
基于ipv6的无人车自动轨迹模糊pid跟随控制方法 Download PDFInfo
- Publication number
- CN107272707B CN107272707B CN201710656870.8A CN201710656870A CN107272707B CN 107272707 B CN107272707 B CN 107272707B CN 201710656870 A CN201710656870 A CN 201710656870A CN 107272707 B CN107272707 B CN 107272707B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- error
- fuzzy
- control
- representing
- 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
- 238000000034 method Methods 0.000 title claims abstract description 28
- 239000002131 composite material Substances 0.000 claims abstract description 15
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 9
- CURLTUGMZLYLDI-UHFFFAOYSA-N Carbon dioxide Chemical compound O=C=O CURLTUGMZLYLDI-UHFFFAOYSA-N 0.000 claims description 6
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 229910002092 carbon dioxide Inorganic materials 0.000 claims description 3
- 239000001569 carbon dioxide Substances 0.000 claims description 3
- 239000002245 particle Substances 0.000 claims description 3
- 239000013641 positive control Substances 0.000 claims description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 3
- 238000005094 computer simulation Methods 0.000 claims description 2
- 230000004069 differentiation Effects 0.000 claims description 2
- 230000002349 favourable effect Effects 0.000 abstract 1
- 238000013461 design Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- OAICVXFJPJFONN-UHFFFAOYSA-N Phosphorus Chemical compound [P] OAICVXFJPJFONN-UHFFFAOYSA-N 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000007429 general method Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0285—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using signals transmitted via a public communication network, e.g. GSM network
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于IPV6的无人车轨迹模糊跟踪保持方法,该方法通过IPV6网络,将通过客户手机或其它外部设备设置的期望目的地与路线规划要求发送给无人自动驾驶车辆;无人自动驾驶车辆接收到期望目的地与路线规划要求后,根据目的地、地图以及当前交通状况进行路线规划后开始自动驾驶,然后通过测量车辆横向位置相对道路中心线的位置偏差,并根据位置偏差设计模糊与PID相复合算法对车道中心线进行轨迹跟踪,从而实现车辆的安全自动驾驶并到达希望的目的地。本发明方案简单,需要测量的信息少,而且对车辆信息与环境信息无要求,并且由于模糊方法的采用,有利于提高车辆自动驾驶的舒适度。
Description
技术领域
本发明属于无人车轨迹跟踪技术领域,涉及一种基于IPV6网络信息的无人车自动轨迹模糊PID跟随控制方法。
背景技术
随着科学技术的发展,无人自动驾驶的智能车辆在近几年得到了飞速的研究与发展。而随着IPV6网络的研究兴起,采用基于IPV6信息的无人车自动驾驶具有非常良好的应用前景。如用户仅需通过手机等互联网终端设备设定目的地,通过IPV6网络传递给无人车、而无人车通过接收网络信息并进行自动驾驶,即可完成无人驾驶任务,并在不久的将来,将会形成无人出租车,可以大大地节省人力成本。同时无人出租车在遵守交通规则、安全无疲劳驾驶方面有着传统有人出租车所无法媲美的优势。车辆自动驾驶中除了防撞、超车等关键技术外,保持车辆沿车道线的中心线自动安全驾驶是其中的基础问题。
发明内容
为了达到上述目的,本发明提供一种基于IPV6的无人车自动轨迹模糊PID跟随控制方法,进而至少在一定程度上克服由于相关技术的限制和缺陷而导致的一个或者多个问题。
本发明所采用的技术方案是,一种基于IPV6的无人车轨迹模糊跟踪保持方法,按照以下步骤进行:
步骤一,设定期望目的地、导航要求以及路线规划;
步骤二,测量位置误差并对所述位置误差进行积分运算;
步骤三,构建所述位置误差的模糊概念以及控制量前轮转角的模糊概念;
步骤四,构建模糊控制的基本原则,并根据所述模糊控制的基本原则建立模糊规则库;根据所述模糊规则库对所述位置误差进行模糊运算与反模糊化,得到模糊控制量;
步骤五,根据所述位置误差构建前轮转向的PID控制规律;
步骤六,根据所述模糊控制量以及所述前轮转向构建构建复合控制规律。
进一步的,所述步骤一包括以下步骤:
首先,通过手机选定期望的目的地,并设置路线规划要求;其次,无人自动驾驶车辆根据所述目的地、地图以及当前交通信息进行路线规划,并将路线规划结果由IPV6网络传递给用户,经用户确认后完成路线规划,开始自动驾驶,向目的地出发。
进一步的,所述步骤二包括以下步骤:
首先,测量车辆横向位置相对道路中心线的位置误差ys;
最后,根据车辆横向位置相对道路中心线的位置误差ys,采用计算机积分算法生成位置误差积分∫ysdt;其中,dt为控制周期,取值为dt<0.005s。
进一步的,所述步骤三包括以下步骤:
首先,构建所述位置误差ys大小的模糊概念,分为以下五个模糊概念,包括:
ys={NB NM ZO PM PB}
其中,NB表示误差值为负的很大误差、NM表示误差值为负的中等误差、ZO标识误差值几乎为零的零误差、PM表示误差值为正的中等误差、PB表示误差值为正的很大误差;|ys|>2为很大误差,0.4<|ys|<2为中等误差,|ys|<0.4为几乎为零的零误差;
其次,构建控制量前轮转角δz的模糊概念,分为以下五个模糊概念,包括:
δz={NBz NMz ZOz PMz PBz}
其中,NBz表示控制量前轮转角误差值为负的很大误差、NMz表示控制量前轮转角为误差值为负的中等误差、ZOz为控制量前轮转角误差值几乎为零的零误差、PMz表示控制量前轮转角误差值为正的中等误差、PBz表示控制量前轮转角误差值为正的很大误差;并且,选取|δz|>10/57.3为很大误差,1/57.3<|δz|<10/57.3为中等误差,|δz|<1/57.3为几乎为零的零误差。
进一步的,所述步骤四包括以下步骤:
首先,构建如下模糊控制的基本原则:当ys较大时,δz也应当较大;当ys较小时,δz也应当较小;而当ys几乎为0时,δz也应当几乎为0;
其次,根据所述模糊控制的基本原则建立模糊规则库,并根据位置误差ys进行模糊运算与反模糊化,得到模糊控制量δz1。
进一步的,所述步骤五包括:
采用传统的PID控制方法,构造前轮转向δz2的PID控制律如下:
δz2=kp1ys+kp2vs+kp3∫ysdt;
其中,vs为误差微分,与所述横向线速度vx相同;kp1、kp2、kp3为PID控制中的比例参数、微分参数与积分参数。
进一步的,所述步骤六包括:
在所述模糊控制量δz1与前轮转向δz2的基础上,采用线性叠形成最终的复合控制规律δz=kaδz1+δz2,其中,ka为两者的叠加系数。
本发明的有益效果是:本发明一种基于IPV6的无人车自动轨迹模糊PID跟随控制方法,通过IPV6网络,将通过客户手机或其它外部设备设置的期望目的地与路线规划要求发送给无人自动驾驶车辆;无人自动驾驶车辆接收到期望目的地与路线规划要求后,根据目的地、地图以及当前交通状况进行路线规划后开始自动驾驶,然后通过测量车辆横向位置相对道路中心线的位置偏差,并根据位置偏差设计模糊与PID相复合算法对车道中心线进行轨迹跟踪,从而实现车辆的安全自动驾驶并到达希望的目的地;其优点在于方案简单,需要测量的信息少,而且对车辆信息与环境信息无要求,并且由于模糊方法的采用,有利于提高车辆自动驾驶的舒适度。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明提供的基于IPV6的无人车轨迹模糊PID跟踪方法流程图。
图2是本发明提供的无人车模糊PID复合轨迹跟踪方案原理框图。
图3是本发明提供的初始位置偏差为2m时车道线保持位置误差响应曲线。
图4是本发明提供的初始位置偏差为2m时车辆前轮转角曲线。
图5是本发明提供的初始位置偏差为-2m时车道线保持位置误差响应曲线。
图6是本发明提供的初始位置偏差为-2m时车辆前轮转角曲线。
图7是本发明提供的车辆模型摄动随机摄动下初始位置偏差为2m时车道线保持位置误差10次响应曲线。
图8是本发明提供的车辆模型摄动随机摄动下初始位置偏差为-2m时车辆前轮转角10次响应曲线。
图9是本发明提供车辆轨迹跟踪误差的隶属度函数。
图10是本发明提供车辆前轮转角的隶属度函数(单位度)。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
一种基于IPV6的无人车轨迹模糊跟踪方法,参考图1以及图2所示,其思路是:通过IPV6网络,将通过客户手机或其它外部设备设置的期望目的地与路线规划要求发送给无人自动驾驶车辆;无人自动驾驶车辆接收到期望目的地与路线规划要求后,根据目的地、地图以及当前交通状况进行路线规划后开始自动驾驶,然后通过测量车辆横向位置相对道路中心线的位置偏差,并根据位置偏差设计模糊与PID相复合算法对车道中心线进行轨迹跟踪,从而实现车辆的安全自动驾驶并到达希望的目的地。
具体而言,一种基于IPV6的无人车轨迹模糊跟踪保持方法可以按照以下步骤进行:
步骤一:期望目的地的设定、导航要求与路线规划
首先,用户可以通过手机选定期望的目的地,并设置路线规划要求,例如可以包括最小距离或速度最快等要求;其次,经由IPV6网络传递给无人自动驾驶车辆;然后,无人自动驾驶车辆根据上述目的地、地图以及当前交通信息进行路线规划,并将路线规划结果由IPV6网络传递给用户,经用户确认后完成路线规划,开始自动驾驶,向目的地出发。
步骤二:位置误差测量并采用计算机计算位置误差积分
采用摄像头测量车辆横向位置相对道路中心线的位置误差,采用速度传感器测量车辆横向线速度,即可获得上述位置误差的导数。为便于下文说明,将上述测量信息采用如下符号进行描述。
ys:表示车辆横向位置相对道路中心线的位置误差;
根据车辆横向位置相对道路中心线的位置误差ys,采用计算机积分算法生成位置误差积分∫ysdt。计算机算法实现如下:
在初始时刻附初值:
se=0;
在控制的每个周期内,进行累加模拟积分运算如下:
se=se+ys*dt;
其中se代表∫ysdt,dt为控制周期,一般选取为小于0.005s。
说明,在本步骤中,测量方法采用一般通用方法既可,并非本专利权利要求保护范围。而本专利权利要求重点在于保护下面采用上述策略信息构成的模糊与PID复合控制策略的设计上,也就是下面的步骤三、步骤四与步骤五。
步骤三:模糊概念与模糊集定义
首先定义车辆横向位置相对道路中心线的误差测量值ys大小的模糊概念,主要分为以下五个模糊概念,即
ys={NB NM ZO PM PB}
即NB表示误差值为负的很大误差、NM表示误差值为负的中等误差、ZO标识误差值几乎为零的零误差、PM表示误差值为正的中等误差、PB表示误差值为正的很大误差。
在设计中一般选取|ys|>2为很大误差,0.4<|ys|<2为中等误差,|ys|<0.4为几乎为零的零误差;具体可以参考图9所示。
其次,定义控制量前轮转角δz的模糊概念,同样分为以下五个模糊概念,即
δz={NBz NMz ZOz PMz PBz}
相应的即NBz表示控制量前轮转角误差值为负的很大误差、NMz表示控制量前轮转角为误差值为负的中等误差、ZOz为控制量前轮转角误差值几乎为零的零误差、PMz表示控制量前轮转角误差值为正的中等误差、PBz表示控制量前轮转角误差值为正的很大误差。
在设计中,一般取而选取|δz|>10/57.3(单位弧度)为很大误差,1/57.3<|δz|<10/57.3为中等误差,|δz|<1/57.3为几乎为零的零误差,具体可以参考图10所示。
步骤四:模糊规则与模糊算法构造
模糊控制的基本原则为:当ys较大时,δz也应当较大;当ys较小时,δz也应当较小;而当ys几乎为0时,δz也应当几乎为0。
最后根据上述模糊控制的基本原则建立模糊规则库,并采用计算机根据输入误差ys进行模糊运算与反模糊化,得到模糊控制量δz1。
对应上述模糊控制的基本原则,建立如下δz的模糊规则:
R1:IF ys is PB thenδz is PB。即如果ys为正大,则δz为正大。
R2:IF ys is PM thenδz is PM。即如果ys为正中,则δz为正中。
R3:IF ys is ZO thenδz is ZO。即如果ys为几乎为0,则δz为正几乎为0。
R4:IF ys is NB thenδz is NB。即如果ys为负大,则δz为负大。
R5:IF ys is NM thenδz is NM。即如果ys为负中,则δz为负中。
最后根据上述模糊控制的基本原则建立模糊规则库,并采用计算机进行跟进输入误差进行模糊运算与反模糊化,得到模糊控制量δz1。详细过程进一步见下面的计算机案例。
步骤五:PID控制算法构造
采用传统的PID控制方法,构造前轮转向PID控制律如下:
δz2=kp1ys+kp2vs+kp3∫ysdt
其中vs,为误差微分,也就是横向线速度vx。kp1、kp2、kp3为PID控制中的比例参数、微分参数与积分参数,有待设计调试中认真整定选取。
步骤六:复合自动驾驶规律构造
在上述模糊控制与PID控制规律构造的基础上,最后采用两种的线性叠加即形成最终的复合控制规律δz=kaδz1+δz2,其中ka为两者的叠加系数,并对模糊控制与PID控制的参数进行进一步的调整,直到得到满意的效果。
步骤七:根据具体的车辆参数采用计算机仿真手段建立车辆运动模型
根据上述定义,建立智能车辆自动驾驶的运动模型如下:
其中各参数与变量定义如下。
y:表示车辆横向位移;
ψ:表示车辆横向摆角;
δz表示前轮转角。
vx:表示车辆行驶速度,由车辆仪表盘信息获得。
Iz:表示车辆的转动惯量,可查阅车辆物理参数获取;
m:表示车辆质量,可查阅车辆物理参数获取;
lf:表示车辆质心到前轴的距离,可查阅车辆物理参数获取;
lr:表示车辆质心到后轴的距离,可查阅车辆物理参数获取;
Cf:表示车辆的前轮胎刚度,可查阅车辆物理参数获取;
Cr:表示车辆的后轮胎刚度,可查阅车辆物理参数获取;
步骤八:将步骤六得到的复合控制律代入步骤七的车辆运动模型,进行参数调试,选定最终的PID控制参数与模糊控制参数kp1、kp2、kp3、ka,控制参数kp1、kp2、kp3、ka的取值可以为kp1=80/57.3、kp2=2/57.3、kp3=50/57.3;得到满意的车道线保持效果,即完成轨迹自动跟踪设计。
至此,自动驾驶中的对期望轨迹车道线中心线的自动跟踪设计完成,将控制无人车按照预定的路线自动驾驶到第一步设定的目的地。值得说明的时:自动驾驶中的另一大任务即紧急壁障与安全管理功能,由于不是本专利保护的重点技术而没有提及,但其是无人车自动驾驶技术组成中的不可或缺的重要部分。
最后,根据上述模糊PID复合控制原理,采用Matlab软件M语言进行编程如下建立模糊***:
a=newfis('smc_fz');
f1=2/3;
a=addvar(a,'input','e',[-3*f1,3*f1])
a=addmf(a,'input',1,'NB','zmf',[-3*f1,-1*f1]);
a=addmf(a,'input',1,'NM','trimf',[-3*f1,-2*f1,0]);
a=addmf(a,'input',1,'ZO','trimf',[-2*f1,0,2*f1]);
a=addmf(a,'input',1,'PM','trimf',[0,2*f1,3*f1]);
a=addmf(a,'input',1,'PB','smf',[1*f1,3*f1]);
f2=10/3;
a=addvar(a,'output','dk1',[-3*f2,3*f2])
a=addmf(a,'output',1,'NB','zmf',[-3*f2,-1*f2]);
a=addmf(a,'output',1,'NM','trimf',[-2*f2,-1*f2,0]);
a=addmf(a,'output',1,'ZO','trimf',[-1*f2,0,1*f2]);
a=addmf(a,'output',1,'PM','trimf',[0,1*f2,2*f2]);
a=addmf(a,'output',1,'PB','smf',[1*f2,3*f2]);
rulelist=[1 1 1 1;
2 2 1 1;
3 3 1 1;
4 4 1 1;
5 5 1 1
];
a1=addrule(a,rulelist);
ag1=a1;
showrule(a1)
a1=setfis(a1,'DefuzzMethod','centroid');
writefis(a1,'smc_fz');
a1=readfis('smc_fz');
figure(15)
plotmf(a1,'input',1);
figure(16)
plotmf(a1,'output',1);
在编写如下程序实现PID控制如下:
kp1=80/57.3;kp2=5/57.3;kp3=50/57.3;
deys=dys;seys=sey;
upid=kp1*eys+kp2*deys+kp3*seys;
其中,kp1=80/57.3、kp2=2/57.3、kp3=50/57.3;
编写如下程序实现模糊与PID复合控制如下:
delt2=-5*evalfis(eys,ag1)/57.3-1upid;
显然显然ka=5/57.3。
注意:由于最后控制量出现复合,相当于前面PID控制参数全部取值为负。
由仿真程序可以看出整个控制方案要调整的参数非常少,一共是四个。同时整个控制方案中,对车辆模型参数、路面参数、轮胎摩擦系数均不要求已知。
因此该控制方案需要测量与已知的信息也非常少,非常便于实现。同时仿真与实验结果表明,由于同时采用了PID与模糊控制,使得方案具有很高的可靠性与安全性,而且还有很好的智能性与舒适性。详见仿真结果如后面图2至图8所示,尤其是图7与图8所展现的车辆模型随机摄动多次仿真曲线,表明了本发明所提供的方法具有良好的实用性。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
本说明书中的各个实施例均采用相关的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。
以上所述仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等,均包含在本发明的保护范围内。
Claims (1)
1.一种基于IPV6的无人车轨迹模糊跟踪保持方法,其特征在于,按照以下步骤进行:
步骤一,设定期望目的地、导航要求以及路线规划;
步骤二,测量位置误差并对所述位置误差进行积分运算;
步骤三,构建所述位置误差的模糊概念以及控制量前轮转角的模糊概念;
步骤四,构建模糊控制的基本原则,并根据所述模糊控制的基本原则建立模糊规则库;根据所述模糊规则库对所述位置误差进行模糊运算与反模糊化,得到模糊控制量;
步骤五,根据所述位置误差构建前轮转向的PID控制规律;
步骤六,根据所述模糊控制量以及所述前轮转向构建复合控制规律;
所述步骤一包括以下步骤:
首先,通过手机选定期望的目的地,并设置路线规划要求;其次,无人自动驾驶车辆根据所述目的地、地图以及当前交通信息进行路线规划,并将路线规划结果由IPV6网络传递给用户,经用户确认后完成路线规划,开始自动驾驶,向目的地出发;
所述步骤二包括以下步骤:
首先,测量车辆横向位置相对道路中心线的位置误差ys;
最后,根据车辆横向位置相对道路中心线的位置误差ys,采用计算机积分算法生成位置误差积分∫ysdt;其中,dt为控制周期,取值为dt<0.005s;
所述步骤三包括以下步骤:
首先,构建所述位置误差ys大小的模糊概念,分为以下五个模糊概念,包括:
ys={NB NM ZO PM PB}
其中,NB表示误差值为负的很大误差、NM表示误差值为负的中等误差、ZO标识误差值几乎为零的零误差、PM表示误差值为正的中等误差、PB表示误差值为正的很大误差;|ys|>2为很大误差,0.4<|ys|<2为中等误差,|ys|<0.4为几乎为零的零误差;
其次,构建控制量前轮转角δz的模糊概念,分为以下五个模糊概念,包括:
δz={NBz NMz ZOz PMz PBz}
其中,NBz表示控制量前轮转角误差值为负的很大误差、NMz表示控制量前轮转角为误差值为负的中等误差、ZOz为控制量前轮转角误差值几乎为零的零误差、PMz表示控制量前轮转角误差值为正的中等误差、PBz表示控制量前轮转角误差值为正的很大误差;并且,选取|δz|>10/57.3为很大误差,1/57.3<|δz|<10/57.3为中等误差,|δz|<1/57.3为几乎为零的零误差;
所述步骤四包括以下步骤:
首先,构建如下模糊控制的基本原则:当ys较大时,δz也应当较大;当ys较小时,δz也应当较小;而当ys几乎为0时,δz也应当几乎为0;
其次,根据所述模糊控制的基本原则建立模糊规则库,并根据位置误差ys进行模糊运算与反模糊化,得到模糊控制量δz1;
所述步骤五包括:
采用传统的PID控制方法,构造前轮转向δz2的PID控制律如下:
δz2=kp1ys+kp2vs+kp3∫ysdt;
其中,vs为误差微分,与所述横向线速度vx相同;kp1、kp2、kp3为PID控制中的比例参数、微分参数与积分参数;kp1=80/57.3、kp2=2/57.3、kp3=50/57.3;
所述步骤六包括:
在所述模糊控制量δz1与前轮转向δz2的基础上,采用线性叠形成最终的复合控制规律δz=kaδz1+δz2,其中,ka为两者的叠加系数,ka=5/57.3;
其中,所述PID控制中的比例参数、微分参数与积分参数是通过如下方式计算得到的:
首先,根据具体的车辆参数采用计算机仿真手段建立车辆运动模型,具体如下所示:
其中:
y:表示车辆横向位移;
ψ:表示车辆横向摆角;
δz:表示前轮转角;
vx:表示车辆行驶速度,由车辆仪表盘信息获得;
Iz:表示车辆的转动惯量,通过查阅车辆物理参数获取;
m:表示车辆质量,通过查阅车辆物理参数获取;
lf:表示车辆质心到前轴的距离,通过查阅车辆物理参数获取;
lr:表示车辆质心到后轴的距离,通过查阅车辆物理参数获取;
Cf:表示车辆的前轮胎刚度,通过查阅车辆物理参数获取;
Cr:表示车辆的后轮胎刚度,通过查阅车辆物理参数获取;
其次,将步骤六得到的复合控制律代入上述车辆运动模型,进行参数调试,选定最终的PID控制参数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710656870.8A CN107272707B (zh) | 2017-08-03 | 2017-08-03 | 基于ipv6的无人车自动轨迹模糊pid跟随控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710656870.8A CN107272707B (zh) | 2017-08-03 | 2017-08-03 | 基于ipv6的无人车自动轨迹模糊pid跟随控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107272707A CN107272707A (zh) | 2017-10-20 |
CN107272707B true CN107272707B (zh) | 2020-11-27 |
Family
ID=60075502
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710656870.8A Active CN107272707B (zh) | 2017-08-03 | 2017-08-03 | 基于ipv6的无人车自动轨迹模糊pid跟随控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107272707B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108279563B (zh) * | 2018-01-25 | 2019-01-29 | 武汉理工大学 | 一种速度自适应的无人车轨迹跟踪pid控制方法 |
CN108303982B (zh) * | 2018-01-31 | 2021-11-30 | 深圳力子机器人有限公司 | 自动引导运输车、其控制方法及控制*** |
CN110390225A (zh) * | 2018-04-16 | 2019-10-29 | 广州番禺职业技术学院 | 车辆视频巡线*** |
CN109283926A (zh) * | 2018-08-16 | 2019-01-29 | 郑州轻工业学院 | 一种基于程序方位角的车辆沿车道线自动驾驶的方法 |
CN109375499A (zh) * | 2018-08-29 | 2019-02-22 | 江苏坚诺机电测试技术有限公司 | Pid闭环控制***及其控制方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2004012139A2 (en) * | 2002-07-31 | 2004-02-05 | Yamaha Motor Co., Ltd | Intelligent mechatronic control suspension system based on quantum soft computing |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2977436B2 (ja) * | 1994-02-25 | 1999-11-15 | 三菱重工業株式会社 | 自動航行制御方法 |
CN1333548C (zh) * | 2004-05-10 | 2007-08-22 | 中国科学院计算技术研究所 | 利用通信技术实现城市道路交通汽车流量调节的方法 |
JP4646923B2 (ja) * | 2005-01-07 | 2011-03-09 | 株式会社ナビタイムジャパン | ナビゲーションシステムおよび携帯端末装置 |
CN100504694C (zh) * | 2007-07-04 | 2009-06-24 | 华南农业大学 | 一种农业机械的导航控制方法 |
CN101221447A (zh) * | 2008-01-18 | 2008-07-16 | 中国农业大学 | 一种机械自动转向控制方法 |
CN102333118B (zh) * | 2011-10-08 | 2013-06-12 | 常熟理工学院 | 一种车载网络IPv6地址自动配置的实现方法 |
FR2993376B1 (fr) * | 2012-07-12 | 2014-07-25 | Renault Sa | Procede de controle de trajectoire d'un vehicule autonome a roues directrices |
CN103237326B (zh) * | 2013-04-07 | 2015-09-02 | 常熟理工学院 | 一种基于跨层的车载网移动切换方法 |
CN103309233A (zh) * | 2013-05-13 | 2013-09-18 | 陕西国防工业职业技术学院 | 一种模糊pid控制器的设计方法 |
CN103970137A (zh) * | 2014-05-08 | 2014-08-06 | 北京理工大学 | 基于自抗扰的alv横向位移跟踪***控制方法 |
CN103970138B (zh) * | 2014-05-08 | 2017-08-11 | 北京理工大学 | 基于自抗扰与微分平滑的alv横向控制方法 |
CN103995535A (zh) * | 2014-06-04 | 2014-08-20 | 苏州工业职业技术学院 | 基于模糊控制的pid控制器路径控制方法 |
CN106504163A (zh) * | 2016-10-18 | 2017-03-15 | 吴江智远信息科技发展有限公司 | 一种基于IPv6的智慧出租管理平台 |
-
2017
- 2017-08-03 CN CN201710656870.8A patent/CN107272707B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2004012139A2 (en) * | 2002-07-31 | 2004-02-05 | Yamaha Motor Co., Ltd | Intelligent mechatronic control suspension system based on quantum soft computing |
Non-Patent Citations (3)
Title |
---|
Fuzzy PID controller for UAV tracking moving target;Weiyong Si等;《2017 29th Chinese Control And Decision Conference (CCDC)》;20170530;第3023-3027页 * |
一种无人驾驶车辆路径跟踪控制方式研究;龚毅;《中国优秀硕士学位论文全文数据库信息科技辑》;20140715(第07(2014)期);第I140-303页 * |
棉花打顶机械手的Fuzzy-PID控制;宋欢,等;《江苏农业科学》;20170331(第3期);第172-175页 * |
Also Published As
Publication number | Publication date |
---|---|
CN107272707A (zh) | 2017-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107272707B (zh) | 基于ipv6的无人车自动轨迹模糊pid跟随控制方法 | |
CN107340772B (zh) | 一种面向无人驾驶的拟人化参考轨迹规划方法 | |
CN107161207B (zh) | 一种基于主动安全的智能汽车轨迹跟踪控制***及控制方法 | |
Ni et al. | Envelope control for four-wheel independently actuated autonomous ground vehicle through AFS/DYC integrated control | |
CN108227491B (zh) | 一种基于滑模神经网络的智能车轨迹跟踪控制方法 | |
Song et al. | A novel integrated chassis controller for full drive-by-wire vehicles | |
Cai et al. | Implementation and development of a trajectory tracking control system for intelligent vehicle | |
Chen et al. | Dynamic drifting control for general path tracking of autonomous vehicles | |
Ni et al. | Robust path following control at driving/handling limits of an autonomous electric racecar | |
CN105857306A (zh) | 一种用于多种泊车场景的车辆自主泊车路径规划方法 | |
CN107298103A (zh) | 一种智能电动汽车自动换道分层控制***及方法 | |
CN113650609B (zh) | 基于模糊规则的人机共驾控制权柔性转移方法及*** | |
CN110471289B (zh) | 一种基于视觉导航移动设备的自适应路径跟踪方法及*** | |
CN114379583B (zh) | 一种基于神经网络动力学模型的自动驾驶车辆轨迹跟踪***及方法 | |
CN108773376A (zh) | 一种融合驾驶意图的汽车多目标分层协同控制与优化方法 | |
CN207328574U (zh) | 一种基于主动安全的智能汽车轨迹跟踪控制*** | |
Lian et al. | Lateral collision avoidance robust control of electric vehicles combining a lane-changing model based on vehicle edge turning trajectory and a vehicle semi-uncertainty dynamic model | |
Yang et al. | EMPC with adaptive APF of obstacle avoidance and trajectory tracking for autonomous electric vehicles | |
Yang et al. | A linear time-varying MPC method for vehicle path-following assistance based on steering torque | |
Huang et al. | Adaptivity-enhanced path tracking system for autonomous vehicles at high speeds | |
Li et al. | Adaptive sliding mode control of lateral stability of four wheel hub electric vehicles | |
CN110703775A (zh) | 一种基于改进人工势场的商用车车道保持路径规划方法 | |
Huang et al. | Finite-time fault-tolerant integrated motion control for autonomous vehicles with prescribed performance | |
Rodríguez Licea et al. | The rollover risk in delta tricycles: A new rollover index and its robust mitigation by rear differential braking | |
Cao et al. | Application of fuzzy control in four wheel steering control system |
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 |