Added compass work. Some more bug fixes needed and.