Real-Time Trajectory Planning for Autonomous Urban Driving: Framework, Algorithms, and Verifications

Real-Time Trajectory Planning for Autonomous Urban Driving: Framework, Algorithms, and Verifications

目的

  1. generating dynamically feasible trajectories in real time with limited onboard computational resources;
  2. dealing with the unpredictably changing surrounding environments with limited sensing range and visibility as well as the uncertainty and noise in the perception and localization systems;
    3)interacting with other traffic participants, such as vehicles, cyclists, and pedestrians

系统框架

在这里插入图片描述
Sensors:感知系统和精确定位
在这里插入图片描述
结果如图,粉色为检测到的障碍,白线为地图上的数据

在这里插入图片描述

we employ a nonlinear optimization approach to smoothen the centerline, then interpolate it using the cubic B-spline curve.
结果:光滑的线

为什么解耦成横向和纵向误差

As referred in [13], to mimic human-like driving behaviors in urban environments, the vehicle trajectory could be naturally decoupled into thelateralmovementandthelongitudinalmovement.

空间坐标、速度坐标基于曲线坐标系
the trajectory planning taskis decomposed into spatial path planning and velocity planning subtasks based on the curvilinear coordinate instead of the Cartesian coordinate

系统算法

the graph-search algorithm 图搜索算法找出无碰撞的参考路线

A、参考路径光滑和插值

the right boundary and left boundary of the desired lane
直接计算出参考路径,但不连续或者不光滑,不容易底层控制器的控制,
会使控制过载或震荡( overshoots and oscillations)
急转弯时,会有很大的横向加速度

共轭梯度优化算法( the conjugate gradient optimization method)
作用:使参考路线光滑
局部最优解:Like the other nonlinear optimization methods, the conjugate gradient algorithm only returns a local optimal solution.
在这里插入图片描述

顶点距离有时过大,采用三次B-样条插值
To obtain dense waypoints, we use the cubic B-spline for interpolation.
在这里插入图片描述
environmental constraints 环境约束没有考虑

B、 Spatial Path Generation Based on the Curvilinear Coordinate Framework (基于曲线坐标框架的空间路径生成)

the sampling-based motion planning strategy

trajectories that are aligned withthe road geometry
更安全,跟友好,缩小解空间
曲线坐标系分别处理汽车横纵向移动(lateral and longitudinal movements of vehicles)

we decompose the trajectory planning task into spatial path generation (空间路径生成)and velocity profile generation(速度剖面生成) subtasks

经过处理的参考路径作为基准坐标系(the refined reference path is taken as the base frame)

ICRA12_A Real-Time Motion Planner with Trajectory Optimization for Autonomous Vehicles.pdf IEEE_CASE2014_Design of Lane Keeping System Using Adaptive Model Predictive Control.pdf IEEE_CDC2012_Werling_AutomaticCollisionAvoidanceUsingModel-predictiveOnlineOptimization.pdf IEEE_ICRA2010_werling-optimal-trajectory-generation-for-dynamic-street-scenarios-in-a-frenet-frame.pdf IEEE_IROS2016_Snider_Automated Tactical Maneuver Discovery, Reasoning and Trajectory Planning for Automated Driving.pdf IEEE_ITSC2005_A new approach to lane guidance systems.pdf IEEE_ITSC2011_Algebraic nonlinear estimation and flatness-based lat lon conrol or automotive vehicles.pdf IEEE_ITSC2011_The H2-Optimal Preview Controller for a Shared Lateral Control.pdf IEEE_ITSC2013_Linear Model Predictive Control for Lane Keeping and Obstacle Avoidance on Low Curvature Roads.pdf IEEE_ITSC2016_Optimal Trajectory Planning for Autonomous Driving Integrating Logical Constraints_An MIQP Perspective.pdf IEEE_IV2010_Safety Verification of Autonomous Vehicles for Coordinated Evasive Maneuvers.pdf IEEE_IV2012_Learning Lane Change Trajectories From On-road Driving Data.pdf IEEE_IV2013_Higher_Order_Sliding_Mode_Control_for_Lateral_Dynamics_V0.pdf IEEE_IV2013_Robust Predictive Control for Semi-Autonomous Vehicles with an certain drivier model.pdf IEEE_IV2013_Snider_Focused Trajectory Planning for Autonomous On-Road Driving.pdf IEEE_TransHMS2017_Modeling, Identification, and Predictive Control of a Driver Steering Assistance System.pdf IEEE_TransSMC_2009Combined Automatic Lane-Keeping and Driver's Steering Through a 2-DOF Control Strategy.pdf" IEEE-TransIE2014_A real time energy optimal trajectory generation method for a servomotor system.pdf IEEE-TransITS2014_Ziegler_Making Bertha Drive-An Autonomous Journey on a Historic Route.pdf IJRR_Journal_2012_Werling_Optimal-trajectories-for-time-critical-street-scenarios-using-discretized-terminal-manifolds.pdf IROS_2015_Tunable and Stable Real-Time Trajectory Planning for Urban Autonomous Driving.pdf AI Model for Behaviour Arbitration.pdf Automatic_Steering_Methods_for_Autonomous_Automobile_Path_Tracking.pdf AVEC_2015_Lane Keeping Assistance with Learning-Based Driver Model and Model Predictive Control.pdf hoffmann_stanley_control07.pdf IAS_2014_On-Road Trajectory Planning for General Autonomous Driving with Enhanced Tunability.pdf ICINCO_2017_Time-Energy Optimal Trajectory Planning over a Fixed Path for a Wheel Mobile Robot.pdf ICIRA2012_On-Road Motion Planning for autonomous driving.pdf ICRA_2011_Energy-Optimal Velocity Profiles for Car-Like Robots.pdf
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值