Added Position class. Fixed heading so that it no longer returns

negative degrees and true north is computed