通过使用斯坦利方法车辆路径下列控制转向角
自动驾驶工具箱/车辆控制
该横向控制器斯坦利block计算转向角度命令,以度为单位,根据车辆当前的速度和方向,调整车辆当前的姿态以匹配参考姿态。控制器使用Stanley方法计算这个命令[1],其控制法是基于两者运动学和动力学自行车模型。为了模型之间切换,使用汽车模型参数。
运动学自行车模型适用于低速环境,例如停车场,其中惯性效应是最小的下面的路径。
动态自行车模型适用于高速公路等惯性效应比较明显的高速环境下的路径跟随。该车辆模型提供了描述车辆动力学的附加参数。
您可以为车辆环境的变化自行车模型之间切换。添加两个横向控制器斯坦利块,并为每个块指定不同的自行车模型。例如,参见横向控制教程。
为了计算转向角命令时,控制器最小化了位置误差和当前姿态相对于基准姿态的角度误差。所述车辆的行驶方向决定这些错误值。
当车辆向前行驶时(方向参数是1
):
该位置误差为从前轴中心到路径上参考点的横向距离。
该角误差是前轮相对于参考路径的角度。
当车辆是在反向运动(方向参数是1
):
该位置误差是从后轴的路径上的基准点的中心的横向距离。
该角误差是后轮相对于参考路径的角度。
有关控制器如何最大限度地减少这些错误的运动学和动力学模型自行车的详细信息,请参阅[1]。
[1] Hoffmann, Gabriel M., Claire J. Tomlin, Michael Montemerlo,和Sebastian Thrun。越野自动汽车轨迹跟踪:控制器设计、实验验证和赛车。美国控制会议。2007年,页。2296年至2301年。DOI:10.1109 / ACC.2007.4282788