Differential Algebra / Optimal Control / Path planning / Mathematical Sciences / Physical sciences / Trajectory Optimization / Second Order / Path Planning / Boundary Value Problem / Trajectory Optimization / Second Order / Path Planning / Boundary Value Problem