Bezier(贝塞尔)曲线(五阶)的轨迹规划在自动驾驶中的应用(五)

提供动态轨迹的Bezier轨迹，计算cost minimization 后取cost最小值

clcclear allp0 = [ 0, 0];
%  p1 = [7.5,7.5*4/30];
%  p2= [15,0];
%  p3 = [15,4];
%  p4 = [22.5,22.5*4/30];
%  p5 = [30,4];for i = 1:10j =10;p5(i*j-9, 1 ) = 19+i;p5(i*j-8, 1 ) = 19+i;p5(i*j-7, 1 ) = 19+i;p5(i*j-6, 1 ) = 19+i;p5(i*j-5, 1 ) = 19+i;p5(i*j-4, 1 ) = 19+i;p5(j*i-3, 1 ) = 19+i;p5(j*i-2, 1 ) =19+i;p5(j*i-1, 1) = 19+i;p5(j*i, 1 ) = 19+i;p5(i*j-9, 2 ) = 2;p5(j*i-8, 2 ) = 2.2;p5(j*i-7, 2) =2.4;p5(j*i-6, 2) = 2.6;p5(j*i-5, 2 ) = 2.8;p5(i*j-4, 2 ) = 3;p5(j*i-3, 2 ) = 3.2;p5(j*i-2, 2) =3.4;p5(j*i-1, 2) = 3.6;p5(j*i, 2 ) = 3.8;
endp1(:,1) = p5(:,1)/4;
p1(:,2) = 0;
p2(:,1) = p5(:,1)/2;
p2(:,2) = 0;
p3(:,1) = p2(:,1);
p3(:,2) = p5(:,2);
p4(:,1) = p5(:,1)*3/4;
p4(:,2) = p5(:,2);for i = 1:length(p5)P0 = p0;P1 = p1(i,:);P2 = p2(i,:);P3=  p3(i,:);P4=  p4(i,:);P5=  p5(i,:);for u =0: 0.01:1p(i,:)= (1-u)^5*P0 + 5*(1-u)^4*u*P1 + 10*(1-u)^3*u^2*P2 +...10*(1-u)^2*u^3*P3 +5*(1-u)*u^4*P4 + u^5*P5;i =i+1;endfor i = 1: length(p)plot (p(i,1),p(i,2),'+r')hold onendend

五阶和三阶贝塞尔在采样过程中覆盖的区域基本相同，但是由于五阶曲线本身在连续性上的性质更好一些，所以更加推荐五阶曲线。

蓝色的为三阶曲线，红色的为五阶曲线。

Bezier(贝塞尔)曲线(五阶)的轨迹规划在自动驾驶中的应用(五)相关推荐

Bezier(贝塞尔)曲线(五阶)的轨迹规划在自动驾驶中的应用(六)
本文介绍贝塞尔五阶曲线最为curve smoother的使用,分析关于时间的一阶和二阶导数的连续性,以及曲率的连续性,并给出一个smoother的实例进行效果展示. clcclear allp0 = ...
Bezier(贝塞尔)曲线(三阶)的轨迹规划在自动驾驶中的应用(四)
提供动态轨迹的Bezier轨迹,计算cost minimization 后取cost最小值 clcclear allp0 = [ 0, 0];for i = 1:10j =10;p3(i*j-9, 1 ...
Bezier(贝塞尔)曲线的轨迹规划在自动驾驶中的应用(二)
根据(一)中的理论前提,我们通过matlab进行一次仿真验证: clcclear allp0 = [ 0, 0];p1 = [10,0.5];p2= [20,3.5];p3 = [30,4];%设置控 ...
Bezier(贝塞尔)曲线的轨迹规划在自动驾驶中的应用(一)
本文主要根据Path Generation and Tracking Based on a Bézier Curve for a Steering Rate Controller of Autonom ...
Bezier(贝塞尔)曲线的轨迹规划在自动驾驶中的应用（三）
存储函数: BezierGeneration function p= BezierGeneration (xs,ys,xe,ye,Latoff) % x_start, and x_end means ...
[决策规划算法]自动驾驶中的行为决策
文章目录前言一.有限状态机二.决策树三.基于知识的推理决策四. 基于价值的决策模型前言在多智能体决策的复杂环境中(存在感知不确定性情况下)进行规划这一问题一直是L4.L5级自动驾驶技术的 ...
【CAD算法】【计算机图形学】Bezier贝塞尔曲线生成程序(python/numpy实现)[1]
整个项目,从Bezier曲线的创建,到Coons Patch曲面的实现,再到网格的实现和优化,还有最后对表面的光顺,链接如下: [CAD算法][计算机图形学]Bezier贝塞尔曲线生成程序(pytho ...
计算机图形学作业（七）：利用 OpenGL 绘制 Bezier 贝塞尔曲线
计算机图形学作业( 七):利用 OpenGL 绘制 Bezier 贝塞尔曲线 Bezier 曲线原理 OpenGL 实现思路捕获鼠标点击时的坐标根据顶点画出连续的线段根据顶点画出 Bezier ...
坐标轨迹计算_机器人的轨迹规划与自动导引
机器人的轨迹规划与自动导引轨迹生成轨迹规划(Trajectory Planning)包括两个方面:对于移动机器人(mobile robot)偏向于指移动的路径轨迹规划(path planning) ...

Bezier(贝塞尔)曲线(五阶)的轨迹规划在自动驾驶中的应用(五)

Bezier(贝塞尔)曲线(五阶)的轨迹规划在自动驾驶中的应用(五)相关推荐

最新文章

热门文章