Integrating safety distances with trajectory planning by modifying the occupancy grid for autonomous vehicle navigation.