Control Theory & Path Optimization