Trajectory Deformation Based on Energy Optimization and Obstacle Avoidance | IEEE Conference Publication | IEEE Xplore