Park, Chonhyon, et al. “ITOMP: Incremental Trajectory Optimization for Real-Time Replanning in Dynamic Environments”. Proceedings of the International Conference on Automated Planning and Scheduling, vol. 22, no. 1, May 2012, pp. 207-15, doi:10.1609/icaps.v22i1.13513.