SAFE STATE TO SAFE STATE NAVIGATION

Systems and methods are provided for vehicle navigation. In one implementation, a system may comprise an interface to obtain sensing data of an environment of the host vehicle. A processing device may be configured to determine a planned navigational action for the host vehicle; identify, from the sensing data, a target vehicle in the environment of the host vehicle; predict a distance between the host vehicle and the target vehicle that would result if the planned navigational action was taken; determine a host vehicle braking distance based on a braking capability, acceleration capability, and speed of the host vehicle; determine a target vehicle braking distance, based on a speed and braking capability of the target vehicle; and implement the planned navigational action when the predicted distance of the planned navigational action is greater than a safe longitudinal distance being calculated based on the host vehicle and target vehicle braking distances.