Updated Compass setup, and Nav changes

Signed-off-by: Stanley Lai <stanleylai.sg@gmail.com>