Get compass working, add reset