|
|
|
@ -34,8 +34,8 @@ MPU6050 mpu6050(Wire);
|
|
|
|
long timer = 0;
|
|
|
|
long timer = 0;
|
|
|
|
int bmePresent;
|
|
|
|
int bmePresent;
|
|
|
|
int RXLED = 17; // The RX LED has a defined Arduino pin
|
|
|
|
int RXLED = 17; // The RX LED has a defined Arduino pin
|
|
|
|
int greenLED = 9;
|
|
|
|
int whiteLED = 9;
|
|
|
|
int blueLED = 8;
|
|
|
|
int yellowLED = 8;
|
|
|
|
int Sensor1 = 0;
|
|
|
|
int Sensor1 = 0;
|
|
|
|
float Sensor2 = 0;
|
|
|
|
float Sensor2 = 0;
|
|
|
|
float temp;
|
|
|
|
float temp;
|
|
|
|
@ -132,12 +132,12 @@ void setup() {
|
|
|
|
delay(250);
|
|
|
|
delay(250);
|
|
|
|
blink(500);
|
|
|
|
blink(500);
|
|
|
|
delay(250);
|
|
|
|
delay(250);
|
|
|
|
led_set(greenLED, HIGH);
|
|
|
|
led_set(whiteLED, HIGH);
|
|
|
|
delay(250);
|
|
|
|
delay(250);
|
|
|
|
led_set(greenLED, LOW);
|
|
|
|
led_set(whiteLED, LOW);
|
|
|
|
led_set(blueLED, HIGH);
|
|
|
|
led_set(yellowLED, HIGH);
|
|
|
|
delay(250);
|
|
|
|
delay(250);
|
|
|
|
led_set(blueLED, LOW);
|
|
|
|
led_set(yellowLED, LOW);
|
|
|
|
|
|
|
|
|
|
|
|
if (bme.begin(0x76)) {
|
|
|
|
if (bme.begin(0x76)) {
|
|
|
|
bmePresent = 1;
|
|
|
|
bmePresent = 1;
|
|
|
|
@ -344,14 +344,14 @@ void loop() {
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
if (acceleration > 1.2 * rest)
|
|
|
|
if (acceleration > 1.2 * rest)
|
|
|
|
led_set(greenLED, HIGH);
|
|
|
|
led_set(whiteLED, HIGH);
|
|
|
|
else
|
|
|
|
else
|
|
|
|
led_set(greenLED, LOW);
|
|
|
|
led_set(whiteLED, LOW);
|
|
|
|
|
|
|
|
|
|
|
|
if (rotation > 5)
|
|
|
|
if (rotation > 5)
|
|
|
|
led_set(blueLED, HIGH);
|
|
|
|
led_set(yellowLED, HIGH);
|
|
|
|
else
|
|
|
|
else
|
|
|
|
led_set(blueLED, LOW);
|
|
|
|
led_set(yellowLED, LOW);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
payload_loop(); // sensor extension read function defined in payload_extension.cpp
|
|
|
|
payload_loop(); // sensor extension read function defined in payload_extension.cpp
|
|
|
|
@ -480,8 +480,8 @@ void blink_setup()
|
|
|
|
#if defined __AVR_ATmega32U4__
|
|
|
|
#if defined __AVR_ATmega32U4__
|
|
|
|
pinMode(RXLED, OUTPUT); // Set RX LED as an output
|
|
|
|
pinMode(RXLED, OUTPUT); // Set RX LED as an output
|
|
|
|
// TX LED is set as an output behind the scenes
|
|
|
|
// TX LED is set as an output behind the scenes
|
|
|
|
pinMode(greenLED, OUTPUT);
|
|
|
|
pinMode(whiteLED, OUTPUT);
|
|
|
|
pinMode(blueLED,OUTPUT);
|
|
|
|
pinMode(yellowLED,OUTPUT);
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
|
|
|
|
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
|
|
|
|
@ -554,9 +554,9 @@ delay(length);
|
|
|
|
void led_set(int ledPin, bool state)
|
|
|
|
void led_set(int ledPin, bool state)
|
|
|
|
{
|
|
|
|
{
|
|
|
|
#if defined(ARDUINO_ARCH_STM32F0) || defined(ARDUINO_ARCH_STM32F1) || defined(ARDUINO_ARCH_STM32F3) || defined(ARDUINO_ARCH_STM32F4) || defined(ARDUINO_ARCH_STM32L4)
|
|
|
|
#if defined(ARDUINO_ARCH_STM32F0) || defined(ARDUINO_ARCH_STM32F1) || defined(ARDUINO_ARCH_STM32F3) || defined(ARDUINO_ARCH_STM32F4) || defined(ARDUINO_ARCH_STM32L4)
|
|
|
|
if (ledPin == greenLED)
|
|
|
|
if (ledPin == whiteLED)
|
|
|
|
digitalWrite(PB9, state);
|
|
|
|
digitalWrite(PB9, state);
|
|
|
|
else if (ledPin == blueLED)
|
|
|
|
else if (ledPin == yellowLED)
|
|
|
|
digitalWrite(PB8, state);
|
|
|
|
digitalWrite(PB8, state);
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
@ -565,9 +565,9 @@ void led_set(int ledPin, bool state)
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
#if defined (ARDUINO_ARCH_MBED_RP2040) || (ARDUINO_ARCH_RP2040)
|
|
|
|
#if defined (ARDUINO_ARCH_MBED_RP2040) || (ARDUINO_ARCH_RP2040)
|
|
|
|
if (ledPin == greenLED)
|
|
|
|
if (ledPin == whiteLED)
|
|
|
|
digitalWrite(19, state);
|
|
|
|
digitalWrite(19, state);
|
|
|
|
else if (ledPin == blueLED)
|
|
|
|
else if (ledPin == yellowLED)
|
|
|
|
digitalWrite(18, state);
|
|
|
|
digitalWrite(18, state);
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|