Continuous Trajectory Optimization via B-splines for Multi-jointed Robotic Systems