Figured out that the rotation matrix directions were wrong... still implementing impulsive maneuvering