Traffic-Rule-Compliant Trajectory Repair via Satisfiability Modulo Theories and Reachability Analysis