Autonomous Robots Blog, 30 Jul 2015 This paper describes a collection of optimization algorithms for achieving dynamic planning, control, and state estimation for…