Suppor for MaxsonarI2CXL, cleaned sonar code, fixed bug in MaxsonarI2CXL library, added mavlink message for altitude sensors