Jacobian Planner - Video Ready
Merge Jacobian fixes