Added some compass & LCD code