主要内容

路径平滑样条

用三次样条插值平滑车辆路径

  • 库:
  • 自动驾驶的工具箱

  • 路径平滑样条块

描述

路径平滑样条块通过将输入的参考路径位姿拟合到三次样条曲线上,生成光滑的车辆路径,该路径由一系列离散的位姿组成。给定输入参考路径方向,块也返回对应于每个姿态的方向。

使用此块转换C1连续路径到C2-连续路径。C1-连续路径包括路径规划者返回的Dubins或reed - shepp路径。有关这些路径类型的详细信息,请参见c1 -连续路径和c2 -连续路径

您可以使用一个飞行器控制器来使用返回的姿态和方向,例如横向控制器Stanley块。

港口

输入

全部展开

车辆沿路径的参考姿态,指定为- × 3矩阵的[xyΘ)向量,是姿势的数量。

xy以米为单位指定车辆的位置。Θ指定车辆的方向角度。

数据类型:|

车辆沿路径的参考方向,指定为-1列向量1s(向前运动)和-1s(反向运动)。为参考方向的个数。的每个元素参考方向对应于中的一个姿势RefPoses输入端口。

数据类型:|

输出

全部展开

离散的姿态平滑的路径,返回作为一个N- × 3矩阵的[xyΘ)向量。N姿势的数量是否在输出位姿数参数。

xy以米为单位指定车辆的位置。Θ指定车辆的方向角度。

中的值摆姿势中值的数据类型是否相同RefPoses输入端口。

中每个输出姿势下车辆的行驶方向摆姿势,以N-1列向量1s(向前运动)和-1s(反向运动)。N姿势的数量是否在输出位姿数参数。

中的值方向中值的数据类型是否相同参考方向输入端口。

你可以用方向指定车辆的参考路径。你也可以使用方向,连同康姆伦茨曲率,以生成车辆的参考速度剖面。请参见速度剖面仪街区与城市Simulink中的自动泊车代客泊车金宝app实例

中每个输出姿势处的累积路径长度摆姿势,以N-by-1实值列向量。N姿势的数量是否在输出位姿数参数单位以米为单位。

你可以用康姆伦茨,连同方向曲率,以生成车辆的参考速度剖面。请参见速度剖面仪街区与城市Simulink中的自动泊车代客泊车金宝app实例

依赖关系

要启用该端口,请选择显示输出端口的长度和曲率参数。

在每个输出位姿处的带符号路径曲率摆姿势,以N-by-1实值列向量。N姿势的数量是否在输出位姿数参数。单位是弧度/米。

你可以用曲率,连同方向康姆伦茨,以生成车辆的参考速度剖面。请参见速度剖面仪街区与城市Simulink中的自动泊车代客泊车金宝app实例

依赖关系

要启用该端口,请选择显示输出端口的长度和曲率参数。

参数

全部展开

要在中返回的平滑姿势数摆姿势输出端口,指定为正整数。要增加返回姿态的粒度,请增加该参数值。

姿势之间的最小间隔,以米为单位,指定为正实标量。如果(xy)两个姿势之间的距离小于此值,则块仅使用其中一个姿势进行插值。

块的采样时间,以秒为单位,指定为-1或者作为一个正的实标量。默认的-1表示块从上游块继承了它的采样时间。

选择此参数启用康姆伦茨曲率输出端口。

  • 代码生成-使用生成的C/C++代码模拟模型。第一次运行模拟时,Simulink金宝app®为块生成C/C++代码。只要模型不变,C代码就可以在后续模拟中重用。此选项需要额外的启动时间。

  • 解释执行-使用MATLAB仿真模型®翻译。这个选项缩短了启动时间。在解释执行模式下,可以调试块的源代码。

更多关于

全部展开

算法

  • 路径平滑算法插值通过所有输入参考位姿点的参数三次样条。样条的参数是这些点的累积弦长。[1]

  • 平滑输出路径的切线方向近似匹配车辆在起始姿态和目标姿态时的姿态角。

工具书类

[1]浮子,Michael S。参数三次样条插值与数据多边形的偏差。计算机辅助几何设计. 2008年第25卷第3期,第148-156页。

Lepetic, Marko, Gregor Klancar, Igor Skrjanc, Drago Matko, Bostjan Potocnik。“考虑加速度限制的时间最优路径规划”。机器人技术与自主系统.第45卷,编号3-4,2003年,199-210页。

扩展功能

C/C++代码生成
使用Simulink®Coder™生成C和c++代码。金宝app

介绍了R2019a