diff --git a/test.js b/test.js index a1997be..1bb6dd8 100644 --- a/test.js +++ b/test.js @@ -5,11 +5,15 @@ const lpf2 = new LPF2(); lpf2.scan(); let moveHub = null, - moveHubUUID = "782a5fbbcef64c5cb31ab4791c191f5d"; + moveHubUUID = "782a5fbbcef64c5cb31ab4791c191f5d", + moveHub2 = null, + moveHub2UUID = "2ea54c6e1c744406bdc8567daf3a692a", wedoHub = null, wedoHubUUID = "0ae95acf801e47f9bda4752392756eed"; lpf2.on("discover", (hub) => { + + console.log(hub.uuid); hub.connect(() => { if (hub.uuid === moveHubUUID) { @@ -19,9 +23,26 @@ lpf2.on("discover", (hub) => { moveHub.on("distance", (port, distance) => { console.log(`Distance ${distance} received on port ${port}`); if (distance < 90) { - wedoHub.setMotorSpeed("B", 40); + if (wedoHub) wedoHub.setMotorSpeed("B", 40); + if (moveHub2) moveHub2.setMotorSpeed("D", 40); } else { - wedoHub.setMotorSpeed("B", 0); + if (wedoHub) wedoHub.setMotorSpeed("B", 0); + if (moveHub2) moveHub2.setMotorSpeed("D", 0); + } + }); + + } else if (hub.uuid === moveHub2UUID) { + moveHub2 = hub; + console.log("Connected to Move Hub 2"); + + moveHub2.on("distance", (port, distance) => { + console.log(`Distance ${distance} received on port ${port}`); + if (distance < 90) { + if (wedoHub) wedoHub.setMotorSpeed("B", 40); + if (moveHub) moveHub.setMotorSpeed("D", 40); + } else { + if (wedoHub) wedoHub.setMotorSpeed("B", 0); + if (moveHub) moveHub.setMotorSpeed("D", 0); } }); @@ -32,9 +53,11 @@ lpf2.on("discover", (hub) => { wedoHub.on("distance", (port, distance) => { console.log(`Distance ${distance} received on port ${port}`); if (distance < 90) { - moveHub.setMotorSpeed("D", 40); + if (moveHub) moveHub.setMotorSpeed("D", 40); + if (moveHub2) moveHub2.setMotorSpeed("D", 40); } else { - moveHub.setMotorSpeed("D", 0); + if (moveHub) moveHub.setMotorSpeed("D", 0); + if (moveHub2) moveHub.setMotorSpeed("D", 0); } }); @@ -51,6 +74,7 @@ setInterval(() => { color = color > 10 ? 1 : color + 1; if (moveHub) moveHub.setLEDColor(color); + if (moveHub2) moveHub2.setLEDColor(color); if (wedoHub) wedoHub.setLEDColor(color); -}, 2000); \ No newline at end of file +}, 2000);