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_Extended.ino sync with non extended after changes

Browse Source
pull/296/head
Alan Johnston 2 years ago committed by GitHub
parent 312c9035bb
commit f26919ae11
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194
1 changed files with 109 additions and 32 deletions
Show Stats Download Patch File Download Diff File

141
stempayload/Payload_BME280_MPU6050_XS_Extended/Payload_BME280_MPU6050_XS_Extended.ino
Unescape View File

@ -6,10 +6,20 @@
#include <Adafruit_Sensor.h>
#include <Adafruit_BME280.h>
#include <MPU6050_tockn.h>
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040) // if Arduino Mbed OS RP2040 Boards is used in Arduino IDE
#include <TinyGPS++.h>
#ifdef ARDUINO_ARCH_RP2040
TinyGPSPlus gps;
UART Serial2(8, 9, 0, 0);
#else
#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
@ -17,7 +27,6 @@ UART Serial2(8, 9, 0, 0);
Adafruit_BME280 bme;
MPU6050 mpu6050(Wire);
TinyGPSPlus gps;
long timer = 0;
int bmePresent;
@ -31,7 +40,7 @@ short ee_prom_word_read(int addr);
int first_time = true;
int first_read = true;
#if defined ARDUINO_ARCH_RP2040
#if defined (ARDUINO_ARCH_MBED_RP2040) || (ARDUINO_ARCH_RP2040)
float T2 = 26.3; // Temperature data point 1
float R2 = 167; // Reading data point 1
float T1 = 2; // Temperature data point 2
@ -66,29 +75,45 @@ extern void payload_loop(); // sensor extension read function defined in payloa
void setup() {
Serial.begin(115200); // 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
delay(1000);
delay(2000);
#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!");
#ifdef ARDUINO_ARCH_RP2040
Serial.println("This code is for the Raspberry Pi Pico hardware.");
#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 = 6; i < 22; i++) {
for (int i = 10; i < 22; i++) {
pinMode(i, INPUT);
}
pinMode(26, INPUT);
pinMode(27, INPUT);
pinMode(28, INPUT);
pinMode(15, INPUT_PULLUP); // squelch
pinMode(15, INPUT_PULLUP); // squelch
#endif
blink_setup();
@ -131,7 +156,7 @@ void setup() {
{
Serial.println("Calculating gyro offsets\n");
mpu6050.calcGyroOffsets(true);
#ifndef ARDUINO_ARCH_RP2040
#if !defined (ARDUINO_ARCH_RP2040)
Serial.println("Storing gyro offsets in EEPROM\n");
eeprom_word_write(0, 0xA07);
@ -289,7 +314,7 @@ void loop() {
// Serial.println(result);
// Serial.println("OK");
// Serial.println(counter++);
#ifndef ARDUINO_ARCH_RP2040
#if !defined (ARDUINO_ARCH_RP2040)
if (result == 'R') {
Serial1.println("OK");
delay(100);
@ -305,7 +330,7 @@ void loop() {
#endif
}
#ifdef ARDUINO_ARCH_RP2040
#if defined (ARDUINO_ARCH_MBED_RP2040) || (ARDUINO_ARCH_RP2040)
Serial.print("Squelch: ");
Serial.println(digitalRead(15));
@ -318,7 +343,7 @@ void loop() {
void eeprom_word_write(int addr, int val)
{
#ifndef ARDUINO_ARCH_RP2040
#if !defined(ARDUINO_ARCH_MBED_RP2040) && !defined(ARDUINO_ARCH_RP2040)
EEPROM.write(addr * 2, lowByte(val));
EEPROM.write(addr * 2 + 1, highByte(val));
#endif
@ -326,9 +351,11 @@ void eeprom_word_write(int addr, int val)
short eeprom_word_read(int addr)
{
#ifndef ARDUINO_ARCH_RP2040
return ((EEPROM.read(addr * 2 + 1) << 8) | EEPROM.read(addr * 2));
#endif
int result = 0;
#if !defined(ARDUINO_ARCH_MBED_RP2040) && !defined(ARDUINO_ARCH_RP2040)
result = ((EEPROM.read(addr * 2 + 1) << 8) | EEPROM.read(addr * 2));
#endif
return result;
}
void blink_setup()
@ -347,11 +374,27 @@ void blink_setup()
pinMode(blueLED,OUTPUT);
#endif
#if defined ARDUINO_ARCH_RP2040
pinMode(LED_BUILTIN, OUTPUT);
pinMode(18, OUTPUT); // blue LED on STEM Payload Board v1.3.2
pinMode(19, OUTPUT); // green LED on STEM Payload Board v1.3.2
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
pinMode(LED_BUILTIN, OUTPUT);
pinMode(18, OUTPUT); // blue LED on STEM Payload Board v1.3.2
pinMode(19, OUTPUT); // 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
}
void blink(int length)
@ -365,10 +408,17 @@ void blink(int length)
TXLED0; //TX LED is not tied to a normally controlled pin so a macro is needed, turn LED OFF
#endif
#if defined ARDUINO_ARCH_RP2040
digitalWrite(LED_BUILTIN, HIGH); // set the built-in LED ON
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
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)
@ -380,9 +430,16 @@ delay(length);
TXLED0; //TX LED macro to turn LED ON
#endif
#if defined ARDUINO_ARCH_RP2040
#if defined(ARDUINO_ARCH_MBED_RP2040) && defined(ARDUINO_ARCH_RP2040)
digitalWrite(LED_BUILTIN, LOW); // set the built-in LED OFF
#endif
#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)
@ -398,7 +455,7 @@ void led_set(int ledPin, bool state)
digitalWrite(ledPin, state);
#endif
#ifdef ARDUINO_ARCH_RP2040
#if defined (ARDUINO_ARCH_MBED_RP2040) || (ARDUINO_ARCH_RP2040)
if (ledPin == greenLED)
digitalWrite(19, state);
else if (ledPin == blueLED)
@ -416,14 +473,34 @@ int read_analog()
#if defined(ARDUINO_ARCH_STM32F0) || defined(ARDUINO_ARCH_STM32F1) || defined(ARDUINO_ARCH_STM32F3) || defined(ARDUINO_ARCH_STM32F4) || defined(ARDUINO_ARCH_STM32L4)
sensorValue = analogRead(PA7);
#endif
#if defined ARDUINO_ARCH_RP2040
#if defined (ARDUINO_ARCH_MBED_RP2040) || (ARDUINO_ARCH_RP2040)
sensorValue = analogRead(28);
#endif
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() {
#ifdef ARDUINO_ARCH_RP2040
Serial.println("Getting GPS data");
bool newData = false;
unsigned long start = millis();
@ -468,5 +545,5 @@ void get_gps() {
} else
// Serial.printf("GPS read no new data: %d\n", millis() - start);
;
#endif
}
#endif

Write Preview
Loading…
Cancel
Save

Powered by TurnKey Linux.