From e382a282ecbea9398536569ad91d4c3291481969 Mon Sep 17 00:00:00 2001
From: alanbjohnston <alan.b.johnston@gmail.com>
Date: Mon, 24 Aug 2020 11:27:23 -0400
Subject: [PATCH] added read of Gyro X, Y, and Z from MPU6050 sensor

---
 arduino/Payload_BME280_MPU6050_Pro_Micro.ino | 106 +++++++++++++++++++
 1 file changed, 106 insertions(+)
 create mode 100644 arduino/Payload_BME280_MPU6050_Pro_Micro.ino

diff --git a/arduino/Payload_BME280_MPU6050_Pro_Micro.ino b/arduino/Payload_BME280_MPU6050_Pro_Micro.ino
new file mode 100644
index 00000000..dd01f61e
--- /dev/null
+++ b/arduino/Payload_BME280_MPU6050_Pro_Micro.ino
@@ -0,0 +1,106 @@
+#include <Wire.h>
+#include <Adafruit_Sensor.h>
+#include <Adafruit_BME280.h
+#include <MPU6050_tockn.h>
+
+#define SEALEVELPRESSURE_HPA (1013.25)
+
+//#define TESTING  // Define to test on Serial Monitor
+
+Adafruit_BME280 bme;
+MPU6050 mpu6050(Wire);
+
+int counter = 0;
+int RXLED = 17;  // The RX LED has a defined Arduino pin
+long timer = 0;
+
+void setup() {
+
+  Serial.begin(9600); // Serial Monitor for testing
+
+  Serial1.begin(9600);  // Pi UART
+
+  Serial.println("Starting!");
+
+
+  digitalWrite(RXLED, LOW);   // set the RX LED ON
+  TXLED0; //TX LED is not tied to a normally controlled pin so a macro is needed, turn LED OFF
+  delay(50);              // wait for a second
+  digitalWrite(RXLED, HIGH);   // set the RX LED ON
+  TXLED0; //TX LED is not tied to a normally controlled pin so a macro is needed, turn LED OFF
+
+  if (!bme.begin(0x76)) {
+    Serial.println("Could not find a valid BME280 sensor, check wiring!");
+    while (1);
+  }
+  
+  mpu6050.begin();
+  mpu6050.calcGyroOffsets(true);
+}
+
+void loop() {
+
+#ifdef TESTING
+  if (Serial.available() > 0) {
+    digitalWrite(RXLED, LOW);   // set the RX LED ON
+    TXLED0; //TX LED is not tied to a normally controlled pin so a macro is needed, turn LED OFF
+    delay(50);              // wait for a second
+    digitalWrite(RXLED, HIGH);   // set the RX LED ON
+    TXLED0; //TX LED is not tied to a normally controlled pin so a macro is needed, turn LED OFF
+    char result = Serial.read();
+    //    Serial1.println(result);
+    Serial.print("OK BME280 ");
+    Serial.print(bme.readTemperature());
+    Serial.print(" ");
+    Serial.print(bme.readPressure() / 100.0F);
+    Serial.print(" ");
+    Serial.print(bme.readAltitude(SEALEVELPRESSURE_HPA));
+    Serial.print(" ");
+    Serial.println(bme.readHumidity());
+    
+    mpu6050.update();
+    
+    Serial.print(" MPU6050 ");
+    Serial.print(mpu6050.getGyroX());
+    Serial.print(" ");
+    Serial.print(mpu6050.getGyroY());
+    Serial.print(" ");
+    Serial.println(mpu6050.getGyroZ());
+
+    //  Serial1.println(counter++);
+  }
+#else
+  if (Serial1.available() > 0) {
+    digitalWrite(RXLED, LOW);   // set the RX LED ON
+    TXLED0; //TX LED is not tied to a normally controlled pin so a macro is needed, turn LED OFF
+    delay(50);              // wait for a second
+    digitalWrite(RXLED, HIGH);   // set the RX LED ON
+    TXLED0; //TX LED is not tied to a normally controlled pin so a macro is needed, turn LED OFF
+    char result = Serial1.read();
+//    Serial1.println(result);
+//    Serial1.println("OK ");
+  
+    Serial1.print("OK BME280 ");
+    Serial1.print(bme.readTemperature());
+    Serial1.print(" ");
+    Serial1.print(bme.readPressure() / 100.0F);
+    Serial1.print(" ");
+    Serial1.print(bme.readAltitude(SEALEVELPRESSURE_HPA));
+    Serial1.print(" ");
+    Serial1.println(bme.readHumidity());
+
+    mpu6050.update();
+    
+    Serial1.print(" MPU6050 ");
+    Serial1.print(mpu6050.getGyroX());
+    Serial1.print(" ");
+    Serial1.print(mpu6050.getGyroY());
+    Serial1.print(" ");
+    Serial1.println(mpu6050.getGyroZ());   
+
+//  Serial1.println(counter++);
+  }
+#endif
+
+  delay(100);
+}