Added Compass Navigation

Adds collission & compass navigation