Methods and systems for safe out-of-lane driving

Systems and methods are provided for navigating a vehicle to veer around a lane obstruction safely into a neighboring lane. The system may plan a trajectory around the obstructed lane. Over a temporal horizon, the system determines temporal margins by measuring an amount of time between a predicted state of a moving actor in the neighboring lane and a predicted state of the vehicle. The system identifies a minimum temporal margin of the temporal margins and determines whether the minimum temporal margin is equal to or larger than a required temporal buffer. If the minimum temporal margin is equal to or larger than the required temporal buffer, the system generates a motion control signal to cause the vehicle to follow the trajectory to veer around the obstruction into the neighboring lane. Otherwise, the system generates a motion control signal to cause the vehicle to reduce speed or stop.