Added Compass Position Holding

going to test this on the water soon