AP_HAL_PX4: Map PX4_I2C_BUS_EXPANSION1

libraries/AP_HAL_PX4/I2CDevice.cpp

@@ -53,7 +53,13 @@ uint8_t PX4_I2C::map_bus_number(uint8_t bus) const
 #else
         return 1;
 #endif
-        
+    case 2:
+        // map to expansion bus 2
+#ifdef PX4_I2C_BUS_EXPANSION1
+        return PX4_I2C_BUS_EXPANSION1;
+#else
+        return 2;
+#endif
     }
     // default to bus 1
     return 1;

libraries/AP_HAL_PX4/I2CDevice.h

@@ -70,7 +70,7 @@ public:
     }
     
 private:
-    static const uint8_t num_buses = 2;
+    static const uint8_t num_buses = 3;
     static DeviceBus businfo[num_buses];
     
     uint8_t _busnum;