Closed khayyami closed 8 years ago
CLI commands added: get-states start-state-sampling stop-state-sampling
it prints: rollAngle, rollRateBias pitchAngle, pitchRateBias yawAngle, yawRateBias
Later on when we implement a kalman filter for yawRate and ZVelocity, they need to be implemented in the print outs.
Should print the current state vector, rollAngle, pitchAngle, yawAngle etc...