Safe, efficient waypoint manipulation for path planning of non-holonomic robots | IEEE Conference Publication | IEEE Xplore