Adjusted baro_offset correction and fixed baro alt correction.
Merge branch 'sonar_alt' into iarc2014_sonar