Fixed recoverrotor3d. Bunch of other stuff. Seems to be working well. Pointing and accel functions now generic with methods.