Adds ability to play two horizons at once for comparison, starts work on system to init state estimator on non-level ground.
Merge branch 'master' of github.com:andybarry/flight