pub const STATES: usize = 15;
Dimension of the error state: three each of position, velocity, attitude, accelerometer bias, and gyroscope bias.