SYSTEMS AND METHODS FOR NAVIGATING A VEHICLE

Systems and methods are provided for vehicle navigation. In one implementation, a processing device may be configured to obtain a planned driving action for accomplishing a navigational goal of a host vehicle; receive sensor data from an environment surrounding the host vehicle; identify a target vehicle moving in the environment and a velocity of the target vehicle; calculate, a predicted trajectory for the target vehicle; calculate a planned trajectory for the host vehicle corresponding to the planned driving action; identify an intersection of the planned trajectory for the host vehicle with the predicted trajectory for the target vehicle; determine a braking action of the host vehicle to comply with a safety requirement; and cause the braking action to be applied to decelerate the host vehicle to change the planned trajectory of the host vehicle, until the planned trajectory does not intersect the predicted trajectory of the target vehicle.