Integrating safety distances with trajectory planning by modifying the occupancy grid for autonomous vehicle navigation | IEEE Conference Publication | IEEE Xplore