iLQR 3D quadrotor dynamics in python using roll-pitch-yaw. pydrake simulation of 3D quadrotor cotrolled by LQR, iLQR and iLQR-MPC