senseBox-bike-mcus2.ino

// First sketch for the senseBox:bike working with the second generation for the MCU
// SPS is disabled 
// 

#include <SenseBoxBLE.h>
#include <Wire.h>
#include <SDConfig.h>
#include <SD.h>
#include <Adafruit_HDC1000.h>
#include <sps30.h>
#include <NMEAGPS.h>
#include <Adafruit_MPU6050.h>
#include <NewPing.h>  // http://librarymanager/All#NewPing
#include <vl53l8cx_class.h>

#define TRIGGER_LEFT 1
#define ECHO_LEFT 2
#define MAX_DISTANCE_A 400
NewPing sonarA(TRIGGER_LEFT, ECHO_LEFT, MAX_DISTANCE_A);
VL53L8CX sensor_vl53l8cx_top(&Wire, -1, -1);
static NMEAGPS gps;
// https://github.com/SlashDevin/NeoGPS/blob/master/extras/doc/Data%20Model.md
static gps_fix fix;

// Accelerometer and Gyroscope
Adafruit_MPU6050 mpu;
// Temperatur and humidity
Adafruit_HDC1000 HDC = Adafruit_HDC1000();


int period = 1000;
unsigned long time_now = 0;
bool recording = false;
long last;
long time_start = 0;

float temp = 0;
float humi = 0;
float pm1 = 0;
float pm25 = 0;
float pm4 = 0;
float pm10 = 0;
float accX = 0;
float accY = 0;
float accZ = 0;
float gps_lat = 0;
float gps_lng = 0;
float gps_spd = 0;
float speed;
float latitude;
float longitude;
float dist_l = 0;
struct sps30_measurement m;

float sumAccZ;
float sumAccY;
float sumAccX;

int temperatureCharacteristic = 0;
int humidityCharacteristic = 0;
int PMCharacteristic = 0;
int accelerationCharacteristic = 0;
int GPSCharacteristic = 0;
int distanceCharacteristic = 0;
int GPSFixCharacteristisc = 0;
float status;

String name;



// init all sensors
// todo: give feedback through LED if all is working?
void initsSensors() {
  Serial.print("Ultrasonic...");
  // initUltrasonic();
  initVL53L8CX();
  // ATTENTION! SPS Disabled for essen-auf-raedern
  // Serial.print("SPS30...");
  // initSPS();  Serial.println("done!");
  Serial.print("MPU6050...");
  initBMX();
  Serial.println("done!");
  Serial.print("GPS...");
  Serial.println("done!");
  Serial.print("HDC1080...");
  if (!HDC.begin()) {
    Serial.println("Couldn't find HDC1080!");
  }
  Serial.println("done!");
  Serial.print("Propeller...");
  pinMode(3, OUTPUT);
  delay(100);
  digitalWrite(3, HIGH);
  Serial.println("done!");
}




// set measurements for acceleration, distance, humidity and temperature
void setMeasurements() {
  getAccAmplitudes(&sumAccX, &sumAccY, &sumAccZ);
  handleDistanceVL53L8CX();
  temp = HDC.readTemperature();
  humi = HDC.readHumidity();

}

// starts bluetooth and sets the name according to the Bluetooth Bee
// TODO: can the ID be seen on the hardware? 
void startBluetooth() {
  SenseBoxBLE::start("senseBox-BLE");
  delay(1000);
  name = "senseBox:bike [" + SenseBoxBLE::getMCUId() + "]";
  SenseBoxBLE::setName(name);
  Serial.println(name);
  delay(1000);
  Serial.print("Adding BLE characteristics...");
  SenseBoxBLE::addService("CF06A218F68EE0BEAD048EBC1EB0BC84");
  temperatureCharacteristic = SenseBoxBLE::addCharacteristic("2CDF217435BEFDC44CA26FD173F8B3A8");
  humidityCharacteristic = SenseBoxBLE::addCharacteristic("772DF7EC8CDC4EA986AF410ABE0BA257");
  PMCharacteristic = SenseBoxBLE::addCharacteristic("7E14E07084EA489FB45AE1317364B979");
  accelerationCharacteristic = SenseBoxBLE::addCharacteristic("B944AF10F4954560968F2F0D18CAB522");
  GPSCharacteristic = SenseBoxBLE::addCharacteristic("8EDF8EBB12464329928DEE0C91DB2389");
  distanceCharacteristic = SenseBoxBLE::addCharacteristic("B3491B60C0F34306A30D49C91F37A62B");
  GPSFixCharacteristisc = SenseBoxBLE::addCharacteristic("PPFSSPSPXGIPIIPFFXXPSXSFSSXSPXFF");
  Serial.println("done!");
}

// sends phenomenas to the given BT characteristics
void writeToBluetooth() {
  bool connected = SenseBoxBLE::write(temperatureCharacteristic, temp);
  SenseBoxBLE::write(humidityCharacteristic, humi);
  SenseBoxBLE::write(PMCharacteristic, pm1, pm25, pm4, pm10);
  SenseBoxBLE::write(accelerationCharacteristic, sumAccX, sumAccY, sumAccZ);
  SenseBoxBLE::write(GPSCharacteristic, latitude, longitude, speed);
  SenseBoxBLE::write(distanceCharacteristic, dist_l);
  SenseBoxBLE::write(GPSFixCharacteristisc, status);
}

void resetVariables(){
  sumAccX = 0;
  sumAccY = 0;
  sumAccZ = 0;
}




void setup() {
  Serial.begin(9600);
  Serial.println("Starting Sketch!");
  Serial.println("Initializing sensors..");
  initsSensors();
  Serial.println("Sensor init done! ");
  startBluetooth();
  Serial.println("Bluetooth done!");
  delay(500);
}

void loop() {
  SenseBoxBLE::poll();
  time_start = millis();

  // set global variables for measurements
  setMeasurements();
  // write measurements to bluetooth
  writeToBluetooth();
  // reset acceleration values
  resetVariables();

  time_now = millis();
  while (millis() < time_start + period) {
    SenseBoxBLE::poll();
    delay(5);
  }
}