navigation: Publish sonar data from XMEGA in cm