Matlab 模糊控制 车辆泊车 案例分享

最近看到了一个知网的文献,研究基于模糊控制的自动泊车,复现了论文,

模糊控制方法参看之前的文章:

​matlab模糊控制工具箱使用和模糊控制pid实例参考(一)​

​matlab模糊控制工具箱使用和模糊控制pid实例参考(二)​

Matlab 模糊控制 车辆泊车 案例分享

车辆在倒车的过程中是一定的低速度运动,在这一过程中,车辆的后轮运动轨迹与倒车速度无关,倒车速度只对倒车过程中在固定时间内车辆行驶的距离有影响,而不对行驶路线有影响。车辆的轨迹可以用(xr, yr, θ)表示,为了方便在此用(x, y, θ)来表示。此时,车辆的轨迹 变化控制量为(x, y, θ),直接输出量为 φ。选取 x、y、θ 作为模糊控制的输入变量,φ为输出变量。其中设定输入变量x的模糊集合数为 4,语言变量表示为 LB、LM、LS、XCE;输入变量 y 的模糊集合数为 4,语言变量表示为 FAR、MD、CL、YCE;输入变量

θ 的模糊集合数为 5,语言变量表示为 RBV、RBH、H、RUH、RUV;输出变量φ模糊集合数为 7,语言变量表示为 PB、PM、PS、ZE、NS、NM、NB。在模糊阶段里最重要的是设计隶属函数,而隶属函数的外型就跟设计者要求的特性和经验 有关,一般常见的是用三角形或梯形来描述隶属函数的外型。本文使用的为三角 型隶属度函数。

在 FIS 编辑器中编辑的自动泊车系统的输入与输出量如图所示。

 

Matlab 模糊控制 车辆泊车 案例分享

如图所示,文本建立了 Mamdani 型模糊推理系统,这种推理,从每一个

规则的结果中得到的模糊集通过聚类运算与结果模糊集相组合后,去模糊化(解

模糊)以产生系统输出。解模糊的方法是重心法(centroid)。输入变量 x 的范围

为[0, 90];输入变量 y 的范围为[0,80];输入变量 θ 的范围为[-80, 80];输出变量

φ 的范围为[-45, 45]。

输入变量 x , y ,θ 的隶属度函数如图所示;

 

Matlab 模糊控制 车辆泊车 案例分享

Matlab 模糊控制 车辆泊车 案例分享

Matlab 模糊控制 车辆泊车 案例分享

 

输出变量ϕ 的隶属度函数如图所示

 

Matlab 模糊控制 车辆泊车 案例分享

模糊规则见fis文件,fis文件后台回复 "模糊控制自动泊车"

 

代码如下:

clc;clear;close all;l = 25;w = 20; v = 5; Ts =0.4; %采样时间间隔 - secondN=2000; % 最大循环次数fuzzyfis=readfis('boche.fis');
% x(1) = 10; %汽车起点的x坐标% y(1) = 30; %汽车起点的y坐标% phi(1) =0; %汽车车身起始倾角x(1) = 20; %汽车起点的x坐标y(1) = 30; %汽车起点的y坐标phi(1) =0; %汽车车身起始倾角
figure;pause(1);for i=1:1:N-1 pause(0.1); inputcanshu=[x(i),y(i),phi(i)]; outputcanshu=eval(inputcanshu,fuzzyfis); theta(i)=outputcanshu; x(i+1)=x(i)+v*Ts*cos(phi(i)*pi/180)*cos(theta(i)*pi/180); y(i+1)=y(i)+v*Ts*sin(phi(i)*pi/180)*cos(theta(i)*pi/180); phi(i+1)=phi(i)-(v*Ts*300/l)*sin(theta(i)*pi/180);if x(i+1) >= 100 || y(i+1) >= 90 %如果超出模糊逻辑控制器的输入范围,则停止 break; end x0 = x(i) + w/2*sind(phi(i)); %左前角x坐标 y0 = y(i) - w/2*cosd(phi(i)); %左前角y坐标 x1 = x(i) - w/2*sind(phi(i)); %右前角x坐标 y1 = y(i) + w/2*cosd(phi(i)); %右前角y坐标 p = x(i) - l*cosd(phi(i)); q = y(i) - l*sind(phi(i)); x2 = p + w/2*sind(phi(i)); %左后角x坐标 y2 = q - w/2*cosd(phi(i)); %左后角y坐标 x3 = p - w/2*sind(phi(i)); %右后角x坐标 y3 = q + w/2*cosd(phi(i)); %右后角y坐标 %画汽车后轴中心 plot (x(i), y(i), 'rs'); axis([-20 120 0 100]); xlabel('x - cm');ylabel('y - cm'); hold on grid on; %画车位示意图 h1 = line([-20 40], [60 60]); h2 = line([40 40], [60 95]); h3 = line([40 115], [95 95]); h4 = line([115 115], [60 95]); h5 = line([115 120], [60 60]); set(h1, 'linewidth', 5, 'color', 'b'); set(h2, 'linewidth', 5, 'color', 'b'); set(h3, 'linewidth', 5, 'color', 'b'); set(h4, 'linewidth', 5, 'color', 'b'); set(h5, 'linewidth', 5, 'color', 'b'); %画车身轮廓 l0 = line([x0 x1], [y0 y1]); l1 = line([x1 x3], [y1 y3]); l2 = line([x2 x3], [y2 y3]); l3 = line([x0 x2], [y0 y2]); set(l0, 'linewidth', 4, 'color', 'm'); set(l1, 'linewidth', 2, 'color', 'b'); set(l2, 'linewidth', 4, 'color', 'g'); set(l3, 'linewidth', 2, 'color', 'b');end

结果如图

发表评论

相关文章