scan also 3rd available bus

2026-05-23 16:27:35 +08:00 · 2014-10-28 15:05:41 +01:00
parent 2e4931e3ca
commit 4a3a16475e
1 changed files with 11 additions and 1 deletions
@@ -675,7 +675,17 @@ start()
 		}

 		if (OK != g_dev->init()) {
-			goto fail;
+			delete g_dev;
+			/* try 3rd bus */
+			g_dev = new PX4FLOW(PX4_I2C_BUS_ONBOARD);
+
+			if (g_dev == nullptr) {
+				goto fail;
+			}
+
+			if (OK != g_dev->init()) {
+				goto fail;
+			}
 		}
 	}