#define NUM_LEDS 1
#define LED_PIN 8 /* TODO */
-#define GOOD_VAL 1000
+#define GOOD_VAL 2000
#define I2C_ADDR ICM_20948_I2C_ADDR_AD1
#define CLOCKF 400000
ICM_20948_low_power(&imu, false);
pixel.begin();
- pixel.setBrightness(100);
+ pixel.setBrightness(50);
}
uint16_t xa, ya, za;
int16_t co; // chosen one
struct color c;
+
+ z = z - 16000;
/* find direction */
xa = (x < 0) ? -x : x;
ya = (y < 0) ? -y : y;
if (xa >= GOOD_VAL) {
curr_col = 0;
co = x;
+ Serial.println("X AXIS");
} else if (ya >= GOOD_VAL) {
curr_col = 1;
co = y;
+ Serial.println("Y AXIS");
} else if (za >= GOOD_VAL) {
curr_col = 2;
co = z;
+ Serial.println("Z AXIS");
}
curr_dir = (co < 0) ? 1 : 0;