Upstream shared

can you add this to the multiwii code, i added support for hc-sr04 sonar in the i2c-gps nav.