The Simple QUaternion Extended Attitude Kalman Filter.
That's attitude, not altitude.
To run the simulation tests:
-
Install Eigen3
-
Run
mkdir build && cd build && mkdir output
cmake .. # generate Makefile
cmake --build . # build executable
./run # run tests, output written to ./output