Cloud Motion Vector System for Solar Power Forecasting

#include <Adafruit_Sensor.h>
#include <Adafruit_TSL2561_U.h>
#include <Wire.h>
#include <flash.h>
#include <hw_types.h>

#define rLED RED_LED // the number of the red LED pin
#define gLED GREEN_LED // the number of the gree LED pin
#define bLED BLUE_LED // the number of the blue LED pin

int count = 0,
    arraySize = 0, //buffer array size
    commandCode,
    buttonState = 0;  // variable for reading the pushbutton status
uint32_t timestamp[200][9], //timestamp matrix
         data[200][9]; // data matrix

Adafruit_TSL2561_Unified tsl1 = Adafruit_TSL2561_Unified(0, TSL2561_ADDR_FLOAT, 12345);
Adafruit_TSL2561_Unified tsl2 = Adafruit_TSL2561_Unified(0, TSL2561_ADDR_LOW, 12346);
Adafruit_TSL2561_Unified tsl3 = Adafruit_TSL2561_Unified(0, TSL2561_ADDR_HIGH, 12347);

Adafruit_TSL2561_Unified tsl4 = Adafruit_TSL2561_Unified(1, TSL2561_ADDR_FLOAT, 123458);
Adafruit_TSL2561_Unified tsl5 = Adafruit_TSL2561_Unified(1, TSL2561_ADDR_LOW, 12349);
Adafruit_TSL2561_Unified tsl6 = Adafruit_TSL2561_Unified(1, TSL2561_ADDR_HIGH, 12350);

Adafruit_TSL2561_Unified tsl7 = Adafruit_TSL2561_Unified(2, TSL2561_ADDR_FLOAT, 12351);
Adafruit_TSL2561_Unified tsl8 = Adafruit_TSL2561_Unified(2, TSL2561_ADDR_LOW, 12352);
Adafruit_TSL2561_Unified tsl9 = Adafruit_TSL2561_Unified(2, TSL2561_ADDR_HIGH, 12353);

void configureSensor(void)
{
  /* You can also manually set the gain or enable auto-gain support */
  Wire.setModule(0);
  tsl1.setGain(TSL2561_GAIN_1X);      /* No gain ... use in bright light to avoid sensor saturation */
  tsl2.setGain(TSL2561_GAIN_1X);
  tsl3.setGain(TSL2561_GAIN_1X);
  Wire.setModule(1);
  tsl4.setGain(TSL2561_GAIN_1X);      /* No gain ... use in bright light to avoid sensor saturation */
  tsl5.setGain(TSL2561_GAIN_1X);
  tsl6.setGain(TSL2561_GAIN_1X);
  Wire.setModule(2);
  tsl7.setGain(TSL2561_GAIN_1X);      /* No gain ... use in bright light to avoid sensor saturation */
  tsl8.setGain(TSL2561_GAIN_1X);
  tsl9.setGain(TSL2561_GAIN_1X);
  /* Changing the integration time gives you better sensor resolution (402ms = 16-bit data) */
  Wire.setModule(0);
  tsl1.setIntegrationTime(TSL2561_INTEGRATIONTIME_13MS);      /* fast but low resolution */
  tsl2.setIntegrationTime(TSL2561_INTEGRATIONTIME_13MS);
  tsl3.setIntegrationTime(TSL2561_INTEGRATIONTIME_13MS);
  Wire.setModule(1);
  tsl4.setIntegrationTime(TSL2561_INTEGRATIONTIME_13MS);      /* fast but low resolution */
  tsl5.setIntegrationTime(TSL2561_INTEGRATIONTIME_13MS);
  tsl6.setIntegrationTime(TSL2561_INTEGRATIONTIME_13MS);
  Wire.setModule(2);
  tsl7.setIntegrationTime(TSL2561_INTEGRATIONTIME_13MS);      /* fast but low resolution */
  tsl8.setIntegrationTime(TSL2561_INTEGRATIONTIME_13MS);
  tsl9.setIntegrationTime(TSL2561_INTEGRATIONTIME_13MS);
}

void setup() {
  pinMode(rLED, OUTPUT); // initialize the LED pin as an output
  pinMode(gLED, OUTPUT);
  pinMode(bLED, OUTPUT);

  Serial.begin(115200);
  configureSensor();
}

void loop() {
  String inString = "";
  
  digitalWrite(gLED, HIGH);   // turn the LED on (HIGH is the voltage level)
  
  // Check and save incoming UART messages
  while (Serial.available() > 0) {
    int inChar = Serial.read();
    if (isDigit(inChar)) {
      // convert the incoming byte to a char 
      // and add it to the string:
      inString += (char)inChar; 
    }
    // if you get a newline, print the string,
    // then the string's value:
    if (inChar == '\n') {
      commandCode = inString.toInt();
      //Serial.print("MODE:");
      //Serial.println(commandCode);
    }
  }

  switch (commandCode) {
    case 1: // Collect data and append to CSV format until reset
      Serial.println("SOUTHWEST,SOUTH,SOUTHEAST,WEST,ORIGIN,EAST,NORTHWEST,NORTH,NORTHEAST"); //CSV header
      digitalWrite(gLED, LOW);    // turn the LED off by making the voltage LOW
      while (1) {
        csvCollect();
      }
      
      commandCode = 0; //re-initialize value
      break;    
    case 2: // Collect data and append to TSV format until reset
      digitalWrite(gLED, LOW);    // turn the LED off by making the voltage LOW
      while (1) {
        tsvCollect();
      }
      
      commandCode = 0; //re-initialize value
      break;      
    case 3: // Collect data for a set duration as a test
      digitalWrite(gLED, LOW);    // turn the LED off by making the voltage LOW
      
      digitalWrite(rLED, HIGH);   // Indicate data collection with red LED
      collectData();
      digitalWrite(rLED, LOW);    // turn the LED off by making the voltage LOW

      commandCode = 0; //re-initialize value
      break;      
    case 4: //
      digitalWrite(gLED, LOW);    // turn the LED off by making the voltage LOW
      
      digitalWrite(rLED, HIGH);   // Indicate data collection with red LED
      collectData();
      digitalWrite(rLED, LOW);    // turn the LED off by making the voltage LOW

      digitalWrite(bLED, HIGH);    // Indicate saving with blue LED
      flashSave();
      digitalWrite(bLED, LOW);    // turn the LED off by making the voltage LOW
      
      commandCode = 0; //re-initialize value
      break;
    case 5: // check saved data in flash memory
      digitalWrite(gLED, LOW);    // turn the LED off by making the voltage LOW
      digitalWrite(rLED, HIGH);   // turn the LED on (HIGH is the voltage level 
      printFlash();
      digitalWrite(rLED, LOW);    // turn the LED off by making the voltage LOW   
      
      commandCode = 0; //re-initialize value
      break;         
  }
}

void csvCollect() {
    uint32_t ts = 0,
             lux = 0;
    uint16_t full, ir;
   
    int i = 0;
    
    Wire.setModule(0); //get data from CMV bottom row

    // SOUTHWEST SENSOR
    tsl2.getLuminosity(&full, &ir);
    lux = tsl2.calculateLux(full, ir);
    Serial.print(lux);
    Serial.print(",");
    
    // SOUTH SENSOR
    tsl1.getLuminosity(&full, &ir);
    lux = tsl1.calculateLux(full, ir);
    Serial.print(lux);
    Serial.print(",");

    //SOUTHEAST SENSOR
    tsl3.getLuminosity(&full, &ir);
    lux = tsl3.calculateLux(full, ir);
    Serial.print(lux);
    Serial.print(",");

    Wire.setModule(2); //get data from CMV middle row

    // WEST SENSOR
    tsl8.getLuminosity(&full, &ir);
    lux = tsl8.calculateLux(full, ir);
    Serial.print(lux);
    Serial.print(",");
    
    // ORIGIN SENSOR
    tsl7.getLuminosity(&full, &ir);
    lux = tsl7.calculateLux(full, ir);
    Serial.print(lux);
    Serial.print(",");

    // EAST SENSOR
    tsl9.getLuminosity(&full, &ir);
    lux = tsl9.calculateLux(full, ir);
    Serial.print(lux);
    Serial.print(",");
    
    Wire.setModule(1); //get data from CMV top row

    // NORTHWEST SENSOR
    tsl5.getLuminosity(&full, &ir);
    lux = tsl5.calculateLux(full, ir);   
    Serial.print(lux);
    Serial.print(",");
    
    // NORTH SENSOR
    tsl4.getLuminosity(&full, &ir);
    lux = tsl4.calculateLux(full, ir);
    Serial.print(lux);
    Serial.print(",");

    // NORTHEAST SENSOR
    tsl6.getLuminosity(&full, &ir);
    lux = tsl6.calculateLux(full, ir);
    Serial.println(lux);   
}

void tsvCollect() {
    uint32_t ts = 0,
             lux = 0;
    uint16_t full, ir;
   
    int i = 0;

    Wire.setModule(0);
    
    ts = millis();
    tsl1.getLuminosity(&full, &ir);
    lux = tsl1.calculateLux(full, ir);
    Serial.print(ts);
    Serial.print(" ");
    Serial.print(lux);
    Serial.print(" ");

    ts = millis();
    tsl2.getLuminosity(&full, &ir);
    lux = tsl2.calculateLux(full, ir);
    Serial.print(ts);
    Serial.print(" ");
    Serial.print(lux);
    Serial.print(" ");

    ts = millis();
    tsl3.getLuminosity(&full, &ir);
    lux = tsl3.calculateLux(full, ir);
    Serial.print(ts);
    Serial.print(" ");
    Serial.print(lux);
    Serial.print(" ");

    Wire.setModule(1);

    ts = millis();
    tsl4.getLuminosity(&full, &ir);
    lux = tsl4.calculateLux(full, ir);
    Serial.print(ts);
    Serial.print(" ");
    Serial.print(lux);
    Serial.print(" ");

    ts = millis();
    tsl5.getLuminosity(&full, &ir);
    lux = tsl5.calculateLux(full, ir);
    Serial.print(ts);
    Serial.print(" ");
    Serial.print(lux);
    Serial.print(" ");

    ts = millis();
    tsl6.getLuminosity(&full, &ir);
    lux = tsl6.calculateLux(full, ir);
    Serial.print(ts);
    Serial.print(" ");
    Serial.print(lux);
    Serial.print(" ");

    Wire.setModule(2);

    ts = millis();
    tsl7.getLuminosity(&full, &ir);
    lux = tsl7.calculateLux(full, ir);
    Serial.print(ts);
    Serial.print(" ");
    Serial.print(lux);
    Serial.print(" ");

    ts = millis();
    tsl8.getLuminosity(&full, &ir);
    lux = tsl8.calculateLux(full, ir);
    Serial.print(ts);
    Serial.print(" ");
    Serial.print(lux);
    Serial.print(" ");

    ts = millis();
    tsl9.getLuminosity(&full, &ir);
    lux = tsl9.calculateLux(full, ir);
    Serial.print(ts);
    Serial.print(" ");
    Serial.println(lux);
}

void collectData() {
  uint32_t startTime = 0, //start time of data collection in seconds
           currentTime = 0, //current time in milliseconds
           elapsedTime = 0, //time since collection started
           endTime = 20000; //data collection end time in milliseconds
  uint16_t full, ir;
  int i, j;

  // Initialize counter
  count = 0;

  // Initialize timestamp and data arrays to zero
  for (i = 0; i < 200; i++) {
    for (j = 0; j < 9; j++) {
      timestamp[i][j] = 0;
      data[i][j] = 0;
    }
  }

  startTime = millis(); //get start time

  while (elapsedTime < endTime) {
    //Serial.print(currentTime);
    currentTime = millis();
    elapsedTime = currentTime - startTime;
    Wire.setModule(0);

    // Get sensor data
    timestamp[count][0] = millis();
    tsl1.getLuminosity(&full, &ir);
    data[count][0] = tsl1.calculateLux(full, ir);
    Serial.print(timestamp[count][0]);
    Serial.print(" ");
    Serial.print(data[count][0]);
    Serial.print(" ");

    timestamp[count][1] = millis();
    tsl2.getLuminosity(&full, &ir);
    data[count][1] = tsl2.calculateLux(full, ir);
    Serial.print(timestamp[count][1]);
    Serial.print(" ");
    Serial.print(data[count][1]);
    Serial.print(" ");

    timestamp[count][2] = millis();
    tsl3.getLuminosity(&full, &ir);
    data[count][2] = tsl3.calculateLux(full, ir);
    Serial.print(timestamp[count][2]);
    Serial.print(" ");
    Serial.print(data[count][2]);
    Serial.print(" ");

    Wire.setModule(1);

    timestamp[count][3] = millis();
    tsl4.getLuminosity(&full, &ir);
    data[count][3] = tsl4.calculateLux(full, ir);
    Serial.print(timestamp[count][3]);
    Serial.print(" ");
    Serial.print(data[count][3]);
    Serial.print(" ");

    timestamp[count][4] = millis();
    tsl5.getLuminosity(&full, &ir);
    data[count][4] = tsl5.calculateLux(full, ir);
    Serial.print(timestamp[count][4]);
    Serial.print(" ");
    Serial.print(data[count][4]);
    Serial.print(" ");

    timestamp[count][5] = millis();
    tsl6.getLuminosity(&full, &ir);
    data[count][5] = tsl6.calculateLux(full, ir);
    Serial.print(timestamp[count][5]);
    Serial.print(" ");
    Serial.print(data[count][5]);
    Serial.print(" ");

    Wire.setModule(2);

    timestamp[count][6] = millis();
    tsl7.getLuminosity(&full, &ir);
    data[count][6] = tsl7.calculateLux(full, ir);
    Serial.print(timestamp[count][6]);
    Serial.print(" ");
    Serial.print(data[count][6]);
    Serial.print(" ");

    timestamp[count][7] = millis();
    tsl8.getLuminosity(&full, &ir);
    data[count][7] = tsl8.calculateLux(full, ir);
    Serial.print(timestamp[count][7]);
    Serial.print(" ");
    Serial.print(data[count][7]);
    Serial.print(" ");

    timestamp[count][8] = millis();
    tsl9.getLuminosity(&full, &ir);
    data[count][8] = tsl9.calculateLux(full, ir);
    Serial.print(timestamp[count][8]);
    Serial.print(" ");
    Serial.println(data[count][8]);

    count++;
  }
}

void flashSave() {
  /* Save data and timestamp into memory */
  uint32_t addr = 0x3000, //set starting address block for flash memory
           flashData = 0,
           pui32data[2000]; //buffer;
  int i = 0,
      j = 0,
      k = 0;

  // Initialize data buffer
  for (i = 0; i < 3000; i++) {
    pui32data[i] = 0;
  }
  
  for (i = 0; i < count; i++) {
    for (j = 0; j < 9; j++) {
      pui32data[k] = timestamp[i][j]; //copy timestamp into buffer
      k++; //increment counter

      pui32data[k] = data[i][j]; //copy data into buffer
      k++; //increment counter
    }
  }
  arraySize = k;

  /* Populate data buffer to be sent to memory */
  FlashErase(addr); // erase flash memory block
  FlashErase(0x3400); // erase flash memory block
  FlashErase(0x3600); // erase flash memory block
  FlashErase(0x3800); // erase flash memory block
  FlashErase(0x3C00); // erase flash memory block
  FlashErase(0x4000); // erase flash memory block
  FlashErase(0x4400); // erase flash memory block
  FlashErase(0x4600); // erase flash memory block
  FlashErase(0x4800); // erase flash memory block
  FlashErase(0x4C00); // erase flash memory block
  FlashErase(0x5000); // erase flash memory block
  FlashErase(0x5400); // erase flash memory block
  FlashProgram(pui32data, addr, sizeof(pui32data)); //write data into flash memory
  
  for (i = 0; i < arraySize; i++) {
    flashData = HWREG(addr + (i * 4));
    Serial.println(flashData);
  }
  
  Serial.println(" ");
  Serial.println(arraySize);
  Serial.println(sizeof(pui32data));
}

void printFlash() {
  uint32_t i, j, blk_adr;
  tFlashProtection fx;

  Serial.println("\nPrinting FLASH permission map.");

  for (i = 0; i < 255; ++i) {
    blk_adr = i * 1024;
    fx = FlashProtectGet(blk_adr);

    Serial.print("@");
    Serial.print(blk_adr, HEX);
    Serial.print("\t");
    switch (fx) {
      case (FlashReadWrite):
        Serial.println("Flash can be read and written!");
        printHexBytes((byte*)blk_adr, 1024);
        break;
      case (FlashReadOnly):
        Serial.println("Flash can only be read!");
        printHexBytes((byte*)blk_adr, 1024);
        break;
      case (FlashExecuteOnly):
        Serial.println("Flash can only be executed!");
      default:
        Serial.println("Unknown tFlashProtection value!");
    }
  }
}

void printHexBytes(byte * adr, uint32_t n) {
  uint32_t i, j, k;
  const int deflen = 16;
  char c;
  char str[deflen];

  //Serial.println("");
  for (i = 0; i < n;) {
    //Serial.print("\t");
    Serial.print((uint32_t)&adr[i], HEX);
    Serial.print("\t");
    for (j = i, k = 0; j < (i + deflen); ++j, ++k) {
      c = (char)adr[j];
      if (c < 16)
        Serial.print("  ");
      else
        Serial.print(" ");
      Serial.print(adr[j], HEX);
      if (c >= 32 && c <= 126)
        str[k] = c;
      else
        str[k] = '.';
    }
    i += deflen;
    Serial.print("\t");
    for (j = 0; j < deflen; ++j) {
      Serial.print(str[j]);
    }
    Serial.print("\n");
  }
}