First draft of a tested compass

Got the compass to respond to a few commands