fixed gradients for manipulatorDynamics in the RigidBodyThrust case.  (by throwing a "not implemented yet" error, which forces it to kick out to TaylorVar)
added gradient test to quadrotor example
fixed LQR quadrotor example.