Compass Upgrade

Started on some new code for the compass and movement code. I lied about
being finished today.