Trajectory optimization in both static and dynamic environments | IEEE Conference Publication | IEEE Xplore