OpenGL improvements.

Included in this pull:
- Several openGL improvements. Refer to commit notes.
- More optimied sensor data used for rendering openGL, improving performance.
- Removed redundant code for sensor fusion and the moving average compass.
- Now rendering axes for test purposes.