Trajectory Optimization 1. iterative Linear Quadratic Regulator 2. Sequential Quadratic Programming Dependencies numpy OSQP scipy matplotlib