Filters

Currently only have a 6dof Kalman filter aas an option. See the examples/Avionics folder for an example. The current system is dense and unoptimized, so is likely to change. As such, docs have not been written for it.