Updated get and set Quaternion methods in StateVector to reflect the r,x,y,z order.