Marc/Icreate
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Made calibration simple

Browse Source
This commit is contained in:
marc barbier
2023-04-07 11:04:49 +02:00
parent 59d91e68d9
commit 09fcad45ab
2 changed files with 23 additions and 14 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Arduino/xbox/xbox.ino
+12 -7
View File
@@ -16,9 +16,14 @@
#define LEFT_PIN 11
#define RIGHT_PIN 10
// negative offset of the tof sensors measure
#define OFFSET_TOP 17
#define OFFSET_MID 15
#define OFFSET_BOTTOM 0
#define LASER_FLOOR 5 //increase to increate the minimum distance
#define MULTIPLEXER 0x70
#define LASER_FLOOR 5 //increase to increate the minimum distance
#define ABS(val) (val > 0 ? val : -val)
@@ -128,21 +133,21 @@ void loop() {
selectI2C(0);
bool newState = lasers[0].readRange() < LASER_FLOOR;
bool newState = lasers[0].readRange() - OFFSET_BOTTOM < LASER_FLOOR;
if(newState != laser1State) {
XInput.setButton(BUTTON_B, newState);
laser1State = newState;
}
selectI2C(1);
newState = lasers[1].readRange() - 15 < LASER_FLOOR;
newState = lasers[1].readRange() - OFFSET_MID < LASER_FLOOR;
if(newState != laser2State) {
XInput.setButton(BUTTON_Y, newState);
laser2State = newState;
}
selectI2C(2);
newState = lasers[2].readRange() - 17 < LASER_FLOOR;
newState = lasers[2].readRange() - OFFSET_TOP < LASER_FLOOR;
if(newState != laser3State) {
XInput.setButton(BUTTON_X, newState);
laser3State = newState;
@@ -156,7 +161,7 @@ void loop() {
Serial.println(button);
// o- 13 20 30
// c- 0 15 16
// c- 0 15 17
selectI2C(0);
Serial.println("Laser Bas");
@@ -165,11 +170,11 @@ void loop() {
selectI2C(1);
Serial.println("Laser Mid");
Serial.println(lasers[1].readRange());
Serial.println(lasers[1].readRange() - 15 < LASER_FLOOR);
Serial.println(lasers[1].readRange() < LASER_FLOOR);
selectI2C(2);
Serial.println("Laser Haut");
Serial.println(lasers[2].readRange());
Serial.println(lasers[2].readRange() - 17 < LASER_FLOOR);
Serial.println(lasers[2].readRange() < LASER_FLOOR);
delay(1000);
#endif
}