Minimum-Jerk Trajectory with Constraints

Solve multi-segment kinematic trajectory optimization. Minimum jerk, Chebyshev collocation.

This project uses multi-segment Chebyshev orthogonal collocation to find minimal-jerk kinematic trajectories that pass through a set of desired way-points, while meeting a set of angle and rate constraints along the path. The user can specify the number of way-points and order of the interpolating polynomial between the way-points. Optimization is solved as a quadratic program. Includes example for a 2 link robot arm task.