Automated highway driving motion decision based on optimal control theory
According to driving scenarios, intelligent vehicle is mainly applied on urban driving, highway driving and close zone driving, etc. As one of the most valuable developments, automated highway driving has great progress. This paper focuses on automated highway driving decision, and considering decision efficiency and feasibility, a hierarchical motion planning algorithm based on dynamic programming was proposed, and simultaneously, road coordinate transformation methods were developed to deal with complex road conditions. At first, all transportation user states are transformed into straight road coordinate to simplify modeling and planning, then a set of candidate paths with Bezier form was developed and with the help of obstacles motion prediction, the feasible target paths with collision-free were remains, and via comparing vehicle performance for feasible path, the optimal driving trajectory was generated.