KB8PMY
/
CubeSatSim
mirror of https://github.com/alanbjohnston/CubeSatSim.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Update Payload_BME280_MPU6050_XS.ino revert to v1.2 payload code

Browse Source
old-payload
Alan Johnston 2 months ago committed by GitHub
parent b1c3b28aa9
commit b31b572914
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194
1 changed files with 124 additions and 442 deletions
Show Stats Download Patch File Download Diff File

520
stempayload/Payload_BME280_MPU6050_XS/Payload_BME280_MPU6050_XS.ino
Unescape View File

@ -1,31 +1,11 @@
// code for Pico or Pro Micro or STM32 on the CubeSat Simulator STEM Payload board // code for Pro Micro or STM32 on the CubeSat Simulator STEM Payload board
// works wih CubeSatSim software v1.3.2 or later // answers "OK" on the serial port Serial1 when queried by the Pi
// extra sensors can be added in payload_extension.cpp file
#include <Wire.h> #include <Wire.h>
#include <Adafruit_Sensor.h> #include <Adafruit_Sensor.h>
#include <Adafruit_BME280.h> #include <Adafruit_BME280.h>
#include <MPU6050_tockn.h> #include <MPU6050_tockn.h>
#if !defined(ARDUINO_ARCH_MBED_RP2040) // && defined(ARDUINO_ARCH_RP2040)
#include <EEPROM.h> #include <EEPROM.h>
#endif
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Arduino Mbed OS RP2040 Boards is used in Arduino IDE
#include <TinyGPS++.h>
TinyGPSPlus gps;
UART Serial2(8, 9, 0, 0);
#elif !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards in Arduino IDE
#include <TinyGPS++.h>
TinyGPSPlus gps;
bool check_for_wifi();
bool wifi = false;
int led_builtin_pin;
#else // if Sparkfun Pro Micro or STM32
#include <EEPROM.h>
#endif
#define SEALEVELPRESSURE_HPA (1013.25) #define SEALEVELPRESSURE_HPA (1013.25)
Adafruit_BME280 bme; Adafruit_BME280 bme;
@ -34,24 +14,15 @@ 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 whiteLED = 9; int greenLED = 9;
int yellowLED = 8; int blueLED = 8;
int Sensor1 = 0; int Sensor1 = 0;
float Sensor2 = 0; float Sensor2 = 0;
float temp; void eeprom_word_write(int addr, int val);
int calibration = 0; short eeprom_word_read(int addr);
void ee_prom_word_write(int addr, int val);
short ee_prom_word_read(int addr);
int first_time = true; int first_time = true;
int first_read = true; int first_read = true;
#if defined (ARDUINO_ARCH_MBED_RP2040) || (ARDUINO_ARCH_RP2040)
float T2 = 24; // Temperature data point 1
float R2 = 169; // Reading data point 1
float T1 = 6; // Temperature data point 2
float R1 = 181; // Reading data point 2
#endif
#if defined __AVR_ATmega32U4__ #if defined __AVR_ATmega32U4__
float T2 = 26.3; // Temperature data point 1 float T2 = 26.3; // Temperature data point 1
float R2 = 167; // Reading data point 1 float R2 = 167; // Reading data point 1
@ -69,75 +40,27 @@ int sensorValue;
float Temp; float Temp;
float rest; float rest;
char sensor_end_flag[] = "_END_FLAG_";
char sensor_start_flag[] = "_START_FLAG_";
bool show_gps = true; // set to false to not see all messages
float flon = 0.0, flat = 0.0, flalt = 0.0;
void get_gps();
extern void payload_setup(); // sensor extension setup function defined in payload_extension.cpp
extern void payload_loop(); // sensor extension read function defined in payload_extension.cpp
void setup() { void setup() {
Serial.begin(115200); // Serial Monitor for testing Serial.begin(9600); // Serial Monitor for testing
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
Serial1.setRX(1);
delay(100);
Serial1.setTX(0);
delay(100);
#endif
Serial1.begin(115200); // for communication with Pi Zero
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards in Arduino IDE
EEPROM.begin(512);
#endif
delay(2000); Serial1.begin(115200); // Pi UART faster speed
// Serial1.begin(9600); // Pi UART faster speed
#if defined (ARDUINO_ARCH_MBED_RP2040) && (ARDUINO_ARCH_RP2040)
Serial.println("Pico with Mbed");
#elif !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
Serial.println("Pico with RP2040");
#elif defined(ARDUINO_ARCH_STM32F0) || defined(ARDUINO_ARCH_STM32F1) || defined(ARDUINO_ARCH_STM32F3) || defined(ARDUINO_ARCH_STM32F4) || defined(ARDUINO_ARCH_STM32L4)
Serial.println("STM32");
#elif defined __AVR_ATmega32U4__
Serial.println("Pro Micro");
#else
Serial.println("Unknown board");
#endif
Serial.println("Starting!"); Serial.println("Starting!");
#if defined (ARDUINO_ARCH_MBED_RP2040) || (ARDUINO_ARCH_RP2040)
Serial.println("Starting Serial2 for optional GPS on JP12");
// Serial2.begin(9600); // serial from - some modules need 115200
Serial2.begin(9600); // serial from GPS or other serial sensor. Some GPS need 115200
// set all Pico GPIO connected pins to input
for (int i = 10; i < 22; i++) {
pinMode(i, INPUT);
}
pinMode(26, INPUT);
pinMode(27, INPUT);
pinMode(28, INPUT);
pinMode(15, INPUT_PULLUP); // squelch
#endif
blink_setup(); blink_setup();
blink(500); blink(500);
delay(250); delay(250);
blink(500); blink(500);
delay(250); delay(250);
led_set(whiteLED, HIGH); led_set(greenLED, HIGH);
delay(250); delay(250);
led_set(whiteLED, LOW); led_set(greenLED, LOW);
led_set(yellowLED, HIGH); led_set(blueLED, HIGH);
delay(250); delay(250);
led_set(yellowLED, LOW); led_set(blueLED, LOW);
if (bme.begin(0x76)) { if (bme.begin(0x76)) {
bmePresent = 1; bmePresent = 1;
@ -161,29 +84,12 @@ void setup() {
Serial.println(zOffset, DEC); Serial.println(zOffset, DEC);
mpu6050.setGyroOffsets(xOffset, yOffset, zOffset); mpu6050.setGyroOffsets(xOffset, yOffset, zOffset);
Serial.println("\nTemperature calibration data from EEPROM\n");
T1 = ((float)eeprom_word_read(4)) / 10.0;
R1 = ((float)eeprom_word_read(5));
T2 = ((float)eeprom_word_read(6)) / 10.0;
R2 = ((float)eeprom_word_read(7));
Serial.println(T1, DEC);
Serial.println(R1, DEC);
Serial.println(" ");
Serial.println(T2, DEC);
Serial.println(R2, DEC);
Serial.println(" ");
} }
else else
{ {
Serial.println("Calculating gyro offsets\n"); Serial.println("Calculating gyro offsets and storing in EEPROM\n");
mpu6050.calcGyroOffsets(true);
#if !defined(ARDUINO_ARCH_MBED_RP2040) // && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards is used in Arduino IDE mpu6050.calcGyroOffsets(true);
Serial.println("Storing gyro offsets in EEPROM\n");
eeprom_word_write(0, 0xA07); eeprom_word_write(0, 0xA07);
eeprom_word_write(1, (int)(mpu6050.getGyroXoffset() * 100.0) + 0.5); eeprom_word_write(1, (int)(mpu6050.getGyroXoffset() * 100.0) + 0.5);
@ -194,56 +100,21 @@ void setup() {
Serial.println(((float)eeprom_word_read(1)) / 100.0, DEC); Serial.println(((float)eeprom_word_read(1)) / 100.0, DEC);
Serial.println(((float)eeprom_word_read(2)) / 100.0, DEC); Serial.println(((float)eeprom_word_read(2)) / 100.0, DEC);
Serial.println(((float)eeprom_word_read(3)) / 100.0, DEC); Serial.println(((float)eeprom_word_read(3)) / 100.0, DEC);
Serial.println("\nStoring temperature calibration data in EEPROM\n");
eeprom_word_write(4, (int)(T1 * 10.0) + 0.5);
eeprom_word_write(5, (int) R1);
eeprom_word_write(6, (int)(T2 * 10.0) + 0.5);
eeprom_word_write(7, (int) R2);
T1 = ((float)eeprom_word_read(4)) / 10.0;
R1 = ((float)eeprom_word_read(5));
T2 = ((float)eeprom_word_read(6)) / 10.0;
R2 = ((float)eeprom_word_read(7));
Serial.println(T1, DEC);
Serial.println(R1, DEC);
Serial.println(" ");
Serial.println(T2, DEC);
Serial.println(R2, DEC);
Serial.println(" ");
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards is used in Arduino IDE
if (EEPROM.commit()) {
Serial.println("EEPROM successfully committed\n");
} else {
Serial.println("ERROR! EEPROM commit failed\n");
}
#endif
#endif
} }
payload_setup(); // sensor extension setup function defined in payload_extension.cpp /**/
} }
void loop() { void loop() {
blink(50);
if (Serial1.available() > 0) { if (Serial1.available() > 0) {
Serial.print("Received serial data!!!\n"); blink(50);
delay(10);
while (Serial1.available() > 0) {
char result = Serial1.read(); char result = Serial1.read();
Serial.print(result); // Serial1.println(result);
} // Serial1.println("OK");
Serial.println(" ");
}
{
// if (result == '?') // if (result == '?')
{ {
if (bmePresent) { if (bmePresent) {
Serial1.print(sensor_start_flag);
Serial1.print("OK BME280 "); Serial1.print("OK BME280 ");
Serial1.print(bme.readTemperature()); Serial1.print(bme.readTemperature());
Serial1.print(" "); Serial1.print(" ");
@ -252,22 +123,9 @@ void loop() {
Serial1.print(bme.readAltitude(SEALEVELPRESSURE_HPA)); Serial1.print(bme.readAltitude(SEALEVELPRESSURE_HPA));
Serial1.print(" "); Serial1.print(" ");
Serial1.print(bme.readHumidity()); Serial1.print(bme.readHumidity());
Serial.print("OK BME280 ");
temp = bme.readTemperature();
Serial.print(temp);
Serial.print(" ");
Serial.print(bme.readPressure() / 100.0F);
Serial.print(" ");
Serial.print(bme.readAltitude(SEALEVELPRESSURE_HPA));
Serial.print(" ");
Serial.print(bme.readHumidity());
} else } else
{ {
Serial1.print(sensor_start_flag);
Serial1.print("OK BME280 0.0 0.0 0.0 0.0"); Serial1.print("OK BME280 0.0 0.0 0.0 0.0");
Serial.print("OK BME280 0.0 0.0 0.0 0.0");
} }
mpu6050.update(); mpu6050.update();
@ -285,56 +143,18 @@ void loop() {
Serial1.print(" "); Serial1.print(" ");
Serial1.print(mpu6050.getAccZ()); Serial1.print(mpu6050.getAccZ());
Serial.print(" MPU6050 ");
Serial.print(mpu6050.getGyroX());
Serial.print(" ");
Serial.print(mpu6050.getGyroY());
Serial.print(" ");
Serial.print(mpu6050.getGyroZ());
Serial.print(" ");
Serial.print(mpu6050.getAccX());
Serial.print(" ");
Serial.print(mpu6050.getAccY());
Serial.print(" ");
Serial.print(mpu6050.getAccZ());
sensorValue = read_analog(); sensorValue = read_analog();
// Serial.println(sensorValue); // Serial.println(sensorValue);
Temp = T1 + (sensorValue - R1) *((T2 - T1)/(R2 - R1)); Temp = T1 + (sensorValue - R1) *((T2 - T1)/(R2 - R1));
// Serial1.print(" GPS 0 0 0 TMP "); Serial1.print(" XS ");
Serial1.print(" GPS ");
Serial1.print(flat,4);
Serial1.print(" ");
Serial1.print(flon,4);
Serial1.print(" ");
Serial1.print(flalt,2);
Serial1.print(" TMP ");
Serial1.print(Temp); Serial1.print(Temp);
Serial1.print(" ");
// Serial1.print(" "); Serial1.println(Sensor2);
// Serial1.println(Sensor2);
Serial.print(" GPS ");
Serial.print(flat,4);
Serial.print(" ");
Serial.print(flon,4);
Serial.print(" ");
Serial.print(flalt,2);
// Serial.print(" GPS 0 0 0 TMP ");
Serial.print(" TMP ");
Serial.print(Temp);
// Serial.print(" ");
// Serial.println(Sensor2);
float rotation = sqrt(mpu6050.getGyroX()*mpu6050.getGyroX() + mpu6050.getGyroY()*mpu6050.getGyroY() + mpu6050.getGyroZ()*mpu6050.getGyroZ()); float rotation = sqrt(mpu6050.getGyroX()*mpu6050.getGyroX() + mpu6050.getGyroY()*mpu6050.getGyroY() + mpu6050.getGyroZ()*mpu6050.getGyroZ());
float acceleration = sqrt(mpu6050.getAccX()*mpu6050.getAccX() + mpu6050.getAccY()*mpu6050.getAccY() + mpu6050.getAccZ()*mpu6050.getAccZ()); float acceleration = sqrt(mpu6050.getAccX()*mpu6050.getAccX() + mpu6050.getAccY()*mpu6050.getAccY() + mpu6050.getAccZ()*mpu6050.getAccZ());
// Serial.println(" ");
// Serial.print(rotation); // Serial.print(rotation);
// Serial.print(" "); // Serial.print(" ");
// Serial.println(acceleration); // Serial.println(acceleration);
@ -342,28 +162,19 @@ void loop() {
if (first_read == true) { if (first_read == true) {
first_read = false; first_read = false;
rest = acceleration; rest = acceleration;
Serial.println(" ");
Serial.print("rest acceleration: ");
Serial.println(rest);
} }
if (acceleration > 1.1 * rest) if (acceleration > 1.2 * rest)
led_set(whiteLED, HIGH); led_set(greenLED, HIGH);
else else
led_set(whiteLED, LOW); led_set(greenLED, LOW);
if (rotation > 20) if (rotation > 5)
led_set(yellowLED, HIGH); led_set(blueLED, HIGH);
else else
led_set(yellowLED, LOW); led_set(blueLED, LOW);
} }
payload_loop(); // sensor extension read function defined in payload_extension.cpp
// Serial1.println(" ");
Serial1.println(sensor_end_flag);
Serial.println(" ");
} }
if (Serial.available() > 0) { if (Serial.available() > 0) {
@ -372,104 +183,98 @@ void loop() {
// Serial.println(result); // Serial.println(result);
// Serial.println("OK"); // Serial.println("OK");
// Serial.println(counter++); // Serial.println(counter++);
//#if !defined (ARDUINO_ARCH_RP2040)
if (result == 'R' || result == 'r') { if (result == 'R') {
// Serial1.println("OK"); Serial1.println("OK");
// delay(100); delay(100);
Serial.println("Resetting\n");
first_read = true; first_read = true;
setup(); setup();
} }
else if (result == 'D' || result == 'd') { else if (result == 'C') {
Serial.println("\nCurrent temperature calibration data\n"); Serial.println("Clearing stored gyro offsets in EEPROM\n");
Serial.println(T1, DEC);
Serial.println(R1, DEC);
Serial.println(" ");
Serial.println(T2, DEC);
Serial.println(R2, DEC);
Serial.println("\nCurrent raw temperature reading\n");
Serial.println(sensorValue, DEC);
Serial.println(" ");
}
else if (result == 'C' || result == 'c') {
Serial.println("\nClearing stored gyro offsets in EEPROM\n");
eeprom_word_write(0, 0x00); eeprom_word_write(0, 0x00);
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards is used in Arduino IDE
if (EEPROM.commit()) {
Serial.println("EEPROM successfully committed\n");
} else {
Serial.println("ERROR! EEPROM commit failed\n");
}
#endif
first_time = true; first_time = true;
setup(); setup();
} }
else if (result == 'S' || result == 's') {
Serial.print("\nStoring temperature calibration data point "); // in EEPROM\n"); if ((result == '?') || first_time == true)
Serial.print(calibration + 1); {
Serial.print(" in EEPROM\n"); first_time = false;
if (bmePresent) {
Serial.println(temp); Serial.print("OK BME280 ");
Serial.println(sensorValue); Serial.print(bme.readTemperature());
Serial.println(" "); Serial.print(" ");
Serial.print(bme.readPressure() / 100.0F);
eeprom_word_write(calibration * 2 + 4 , (int)(temp * 10.0) + 0.5); Serial.print(" ");
eeprom_word_write(calibration * 2 + 5, sensorValue); Serial.print(bme.readAltitude(SEALEVELPRESSURE_HPA));
Serial.print(" ");
if (calibration == 0) { Serial.print(bme.readHumidity());
T1 = temp; } else
R1 = sensorValue; {
calibration = 1; Serial.print("OK BME280 0.0 0.0 0.0 0.0");
} else {
T2 = temp;
R2 = sensorValue;
calibration = 0;
} }
mpu6050.update();
// calibration = (calibration + 1) % 2; Serial.print(" MPU6050 ");
// Serial.println(calibration + 1); Serial.print(mpu6050.getGyroX());
Serial.print(" ");
Serial.print(mpu6050.getGyroY());
Serial.print(" ");
Serial.print(mpu6050.getGyroZ());
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards is used in Arduino IDE Serial.print(" ");
Serial.print(mpu6050.getAccX());
Serial.print(" ");
Serial.print(mpu6050.getAccY());
Serial.print(" ");
Serial.print(mpu6050.getAccZ());
if (EEPROM.commit()) { sensorValue = read_analog();
Serial.println("EEPROM successfully committed\n");
} else {
Serial.println("ERROR! EEPROM commit failed\n");
}
#endif
} Temp = T1 + (sensorValue - R1) *((T2 - T1)/(R2 - R1));
//#endif
} Serial.print(" XS ");
Serial.print(Temp);
Serial.print(" ");
Serial.print(Sensor2);
Serial.print(" (");
Serial.print(sensorValue);
Serial.println(")");
float rotation = sqrt(mpu6050.getGyroX()*mpu6050.getGyroX() + mpu6050.getGyroY()*mpu6050.getGyroY() + mpu6050.getGyroZ()*mpu6050.getGyroZ());
float acceleration = sqrt(mpu6050.getAccX()*mpu6050.getAccX() + mpu6050.getAccY()*mpu6050.getAccY() + mpu6050.getAccZ()*mpu6050.getAccZ());
// Serial.print(rotation);
// Serial.print(" ");
// Serial.println(acceleration);
#if defined (ARDUINO_ARCH_MBED_RP2040) || (ARDUINO_ARCH_RP2040) if (first_read == true) {
Serial.print("Squelch: "); first_read = false;
Serial.println(digitalRead(15)); rest = acceleration;
}
get_gps(); if (acceleration > 1.2 * rest)
#else led_set(greenLED, HIGH);
delay(1000); // not needed due to gps 1 second polling delay else
led_set(greenLED, LOW);
#endif if (rotation > 5)
led_set(blueLED, HIGH);
else
led_set(blueLED, LOW);
}
}
delay(100);
} }
void eeprom_word_write(int addr, int val) void eeprom_word_write(int addr, int val)
{ {
#if !defined(ARDUINO_ARCH_MBED_RP2040) // && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards is used in Arduino IDE
EEPROM.write(addr * 2, lowByte(val)); EEPROM.write(addr * 2, lowByte(val));
EEPROM.write(addr * 2 + 1, highByte(val)); EEPROM.write(addr * 2 + 1, highByte(val));
#endif
} }
short eeprom_word_read(int addr) short eeprom_word_read(int addr)
{ {
int result = 0; return ((EEPROM.read(addr * 2 + 1) << 8) | EEPROM.read(addr * 2));
#if !defined(ARDUINO_ARCH_MBED_RP2040) // && defined(ARDUINO_ARCH_RP2040) // if Raspberry Pi RP2040 Boards is used in Arduino IDE
result = ((EEPROM.read(addr * 2 + 1) << 8) | EEPROM.read(addr * 2));
#endif
return result;
} }
void blink_setup() void blink_setup()
@ -484,29 +289,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(whiteLED, OUTPUT); pinMode(greenLED, OUTPUT);
pinMode(yellowLED,OUTPUT); pinMode(blueLED,OUTPUT);
#endif
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
pinMode(LED_BUILTIN, OUTPUT);
pinMode(18, OUTPUT); // yellow LED (was blue LED on STEM Payload Board v1.3.2)
pinMode(19, OUTPUT); // white LED (was green LED on STEM Payload Board v1.3.2)
#endif
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
if (check_for_wifi()) {
wifi = true;
led_builtin_pin = LED_BUILTIN; // use default GPIO for Pico W
pinMode(LED_BUILTIN, OUTPUT);
// configure_wifi();
} else {
led_builtin_pin = 25; // manually set GPIO 25 for Pico board
// pinMode(25, OUTPUT);
pinMode(led_builtin_pin, OUTPUT);
}
pinMode(18, OUTPUT);
pinMode(19, OUTPUT);
#endif #endif
} }
@ -521,18 +305,7 @@ void blink(int length)
TXLED0; //TX LED is not tied to a normally controlled pin so a macro is needed, turn LED OFF TXLED0; //TX LED is not tied to a normally controlled pin so a macro is needed, turn LED OFF
#endif #endif
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) delay(length); // wait for a lenth of time
digitalWrite(LED_BUILTIN, HIGH); // set the built-in LED ON
#endif
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
if (wifi)
digitalWrite(LED_BUILTIN, HIGH); // set the built-in LED ON
else
digitalWrite(led_builtin_pin, HIGH); // set the built-in LED ON
#endif
delay(length);
#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)
digitalWrite(PC13, HIGH); // turn the LED off by making the voltage LOW digitalWrite(PC13, HIGH); // turn the LED off by making the voltage LOW
@ -542,38 +315,20 @@ delay(length);
digitalWrite(RXLED, HIGH); // set the RX LED OFF digitalWrite(RXLED, HIGH); // set the RX LED OFF
TXLED0; //TX LED macro to turn LED ON TXLED0; //TX LED macro to turn LED ON
#endif #endif
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
digitalWrite(LED_BUILTIN, LOW); // set the built-in LED OFF
#endif
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
if (wifi)
digitalWrite(LED_BUILTIN, LOW); // set the built-in LED ON
else
digitalWrite(led_builtin_pin, LOW); // set the built-in LED ON
#endif
} }
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 == whiteLED) if (ledPin == greenLED)
digitalWrite(PB9, state); digitalWrite(PB9, state);
else if (ledPin == yellowLED) else if (ledPin == blueLED)
digitalWrite(PB8, state); digitalWrite(PB8, state);
#endif #endif
#if defined __AVR_ATmega32U4__ #if defined __AVR_ATmega32U4__
digitalWrite(ledPin, state); digitalWrite(ledPin, state);
#endif #endif
#if defined (ARDUINO_ARCH_MBED_RP2040) || (ARDUINO_ARCH_RP2040)
if (ledPin == whiteLED)
digitalWrite(19, state);
else if (ledPin == yellowLED)
digitalWrite(18, state);
#endif
} }
int read_analog() int read_analog()
@ -582,81 +337,8 @@ int read_analog()
#if defined __AVR_ATmega32U4__ #if defined __AVR_ATmega32U4__
sensorValue = analogRead(A3); sensorValue = analogRead(A3);
#endif #endif
#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)
sensorValue = analogRead(PA7); sensorValue = analogRead(PA7);
#endif
#if defined (ARDUINO_ARCH_MBED_RP2040) || (ARDUINO_ARCH_RP2040)
sensorValue = analogRead(28);
#endif #endif
return(sensorValue); return(sensorValue);
} }
#if !defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
bool check_for_wifi() {
pinMode(29, INPUT);
const float conversion_factor = 3.3f / (1 << 12);
uint16_t result = analogRead(29);
// Serial.printf("ADC3 value: 0x%03x, voltage: %f V\n", result, result * conversion_factor);
if (result < 0x10) {
Serial.println("\nPico W detected!\n");
return(true);
}
else {
Serial.println("\nPico detected!\n");
return(false);
}
}
#endif
#if defined (ARDUINO_ARCH_MBED_RP2040) || (ARDUINO_ARCH_RP2040)
void get_gps() {
// Serial.println("Getting GPS data");
bool newData = false;
unsigned long start = millis();
// for (unsigned long start = millis(); millis() - start < 1000;) // 5000;)
while ((millis() - start) < 1000) // 5000;)
{
while (Serial2.available())
{
char c = Serial2.read();
if (show_gps)
Serial.write(c); // uncomment this line if you want to see the GPS data flowing
if (gps.encode(c)) // Did a new valid sentence come in?
newData = true;
}
}
if (newData) {
Serial.print("GPS read new data in ms: ");
Serial.println(millis() - start);
// float flon = 0.0, flat = 0.0, flalt = 0.0;
// unsigned long age;
// starting = millis();
// gps.f_get_position(&flat, &flon, &age);
Serial.print(F("Location: "));
if (gps.location.isValid())
{
Serial.print(gps.location.lat(), 6);
Serial.print(F(","));
Serial.print(gps.location.lng(), 6);
flat = gps.location.lat();
flon = gps.location.lng();
flalt = gps.altitude.meters();
}
else
{
Serial.print(F("INVALID"));
}
Serial.print("\r\n");
} else
// Serial.printf("GPS read no new data: %d\n", millis() - start);
;
}
#endif

Write Preview
Loading…
Cancel
Save

Powered by TurnKey Linux.