ROBUST TRAJECTORY PLANNING USING DATA-DRIVEN REACHABILITY CORRIDORS

• Main Authors: Aguilar Marsillach, Daniel, Jafari Tafti, Sayyed Rouhollah
• Format: Patent
• Language: English
• Published: 13.06.2024
• Subjects: CALCULATING; COMPUTING; CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE ORDIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; COUNTING; PERFORMING OPERATIONS; PHYSICS; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TOTHE CONTROL OF A PARTICULAR SUB-UNIT; TRANSPORTING; VEHICLES IN GENERAL

A vehicle trajectory planning system includes a perception system of a host vehicle collecting information from multiple sources and communicating with a computer. A fusion module fuses scene information from a map and perception items identified by the perception system. A behavior planning module receives an output of the fusion module and produces a host vehicle baseline trajectory. A trajectory and motion planning module receives an output of the fusion module in parallel with the behavior planning module. The trajectory and motion planning module determines a reference trajectory and operation corridor for a host vehicle. A disturbance and reachability refiner module receives an output of the trajectory and motion planning module including the reference trajectory and operation corridor. An algorithm is applied to adjust and re-plan the host vehicle baseline trajectory to be robust to a range of inclement weather conditions.