Conducted empirical experiments of SQP to exact optimal connection for double integrator, set up Informed RRT Star for optimal time