qp-bezier-curve Minimum jerk trajectory optimization based on Bernstein polynomials QP solver quadprog: quadprog_bezier_curve.m OSQP: osqp_bezier_curve.m QPIP: qpip_bezier_curve.m