First draft of a tested compass

Got the compass to respond to a few commands
Merge branch 'sensor' into testing