Constraint-based planning and control for safe, semi-autonomous operation of vehicles | Synapse