Display + altitude Kalman filter

todo:
1. apogee detection
2. PWM for servo
3. relative altitude
Merge branch 'master' of https://github.com/nightmechanic/WRFL