logger.cpp

/** @file logger.cpp
 *  @brief Logger functions.
 *  @author Caio Cotts
 *  @date Feb 14 2022
 */

#include "logger.h"
#include "cursesMatrix.h"
#include "dlgps.h"
#include "font.h"
#include "sensehat.h"
#include <fstream>
#include <iostream>
#include <ncurses.h>
#include <regex>
#include <signal.h>
#include <string>

// Global Objects
SenseHat sh;

using namespace std;

/** @brief Initialize data logger.
 *  @author Caio Cotts
 *  @date Feb 14 2022
 *  @return 0 if initialization successful.
 */
int DlInitialization(void) {

#if CURSE
  DlGpsInit();
  mvprintw(0, 0, "Caio Cotts' CENG252 Vehicle Data Logger\n");
  printw("Data Logger Initialization\n");
  refresh();
  for (int i = 0; i <= 30; i++) {
    printw("#");
    usleep(100000);
    refresh();
  }
  cursDisplayPattern(0, 70, patterns[0]);
  return 0;
#else
  DlGpsInit();
  cout << "Caio Cotts' CENG252 Vehicle Data Logger\n";
  cout << "Data Logger Initialization\n\n";
  return 0;
#endif
}

/** @brief Get serial number of the Raspberry Pi.
 *  @author Caio Cotts
 *  @date Feb 14 2022
 *  @return Unsigned long long
 */
uint64_t DlGetSerial(void) {
  regex rgx("Serial.+: ([0-9]+)");
  smatch match;
  FILE *fp;
  ifstream t("/proc/cpuinfo");
  stringstream buffer;
  buffer << t.rdbuf();
  string buf = buffer.str();
  regex_search(buf, match, rgx);
  uint64_t serial = stoull(match.str(1));

  return serial;
}

/** @brief Get sensor readings.
 *  @author Caio Cotts
 *  @date Feb 14 2022
 *  @return reading_s object
 */
reading_s DlGetLoggerReadings(void) {
  reading_s creads{0};
  creads.rtime = time(NULL);
  loc_t gpsdata{0};

#if GPSDEVICE
  gpsdata = DlGpsLocation();
  creads.latitude = gpsdata.latitude;
  creads.longitude = gpsdata.longitude;
  creads.altitude = gpsdata.altitude;
  creads.speed = gpsdata.speed;

#else
  creads.latitude = DLAT;
  creads.longitude = DLONG;
  creads.altitude = DALT;
  creads.speed = DSPEED;

#endif

#if SENSEHAT
  creads.temperature = sh.GetTemperature();
  creads.humidity = sh.GetHumidity();
  creads.pressure = sh.GetPressure();
  sh.GetAcceleration(creads.xa, creads.ya, creads.za);
  usleep(IMUDELAY);
  sh.GetOrientation(creads.pitch, creads.roll, creads.yaw);
  usleep(IMUDELAY);
  sh.GetMagnetism(creads.xm, creads.ym, creads.zm);
  usleep(IMUDELAY);
  creads.heading = DHEADING;

#else

  creads.temperature = DTEMP;
  creads.humidity = DHUMID;
  creads.pressure = DPRESS;
  creads.xa = DXA;
  creads.ya = DYA;
  creads.za = DZA;
  creads.pitch = DPITCH;
  creads.roll = DROLL;
  creads.yaw = DYAW;
  creads.xm = DXM;
  creads.ym = DYM;
  creads.zm = DZM;
  creads.heading = DHEADING;

#endif

  return creads;
}

/** @brief Print sensor readings to standard out.
 *  @author Caio Cotts
 *  @date Feb 14 2022
 *  @return void
 */
void DlDisplayLoggerReadings(reading_s lreads) {
#if CURSE
  printw("Unit: %Li", DlGetSerial());
  printw(" %s\n", ctime(&lreads.rtime));
  printw("T: %.1fC\t\tH: %.0f%\t\t\tP: %.1fkPa\n", lreads.temperature,
         lreads.humidity, lreads.pressure);
  printw("Xa: %fg\t\tYa: %fg\t\tZa: %fg\n", lreads.xa, lreads.ya, lreads.za);
  printw("Pitch: %f \tRoll: %f\t\tYaw: %f\n", lreads.pitch, lreads.roll,
         lreads.yaw);
  printw("Xm: %f\t\tYm: %f\t\tZm: %f\n", lreads.xm, lreads.ym, lreads.zm);
  printw("Latitude: %f\tLongitude: %f\tAltitude: %f\n", lreads.latitude,
         lreads.longitude, lreads.altitude);
  printw("Speed: %f \tHeading: %f\n\n", lreads.speed, lreads.heading);

#else
  cout << "Unit: " << DlGetSerial();
  printf(" %s\n", ctime(&lreads.rtime));
  printf("T: %.1fC\t\tH: %.0f%\t\t\tP: %.1fkPa\n", lreads.temperature,
         lreads.humidity, lreads.pressure);
  printf("Xa: %fg\t\tYa: %fg\t\tZa: %fg\n", lreads.xa, lreads.ya, lreads.za);
  printf("Pitch: %f \tRoll: %f\t\tYaw: %f\n", lreads.pitch, lreads.roll,
         lreads.yaw);
  printf("Xm: %f\t\tYm: %f\t\tZm: %f\n", lreads.xm, lreads.ym, lreads.zm);
  printf("Latitude: %f\tLongitude: %f\tAltitude: %f\n", lreads.latitude,
         lreads.longitude, lreads.altitude);
  printf("Speed: %f \tHeading: %f\n\n", lreads.speed, lreads.heading);

#endif
}

/** @brief Save sensor readings.
 *  @author Caio Cotts
 *  @date Feb 14 2022
 *  @return 0 if data was saved successfuly
 */
int DlSaveLoggerData(reading_s creads) {
#if CURSE
  mvprintw(15, 70, "Saving Logger Data...\n\n");

  FILE *fp;
  char ltime[TIMESTRSZ];
  char jsondata[PAYLOADSTRSZ];

  fp = fopen("loggerdata.csv", "a");
  if (fp == NULL) {
    return 0;
  }

  strcpy(ltime, ctime(&creads.rtime));

  int commaIndex[] = {3, 7, 10, 19};

  for (int i : commaIndex) {
    ltime[i] = ',';
  }

  fprintf(fp,
          "%.24s,%3.1f,%3.0f,%3.1f,%f,%f,%f,%f,%f,%f,%f,%f,%f,%f,%f,%f,%f,%f\n",
          ltime, creads.temperature, creads.humidity, creads.pressure,
          creads.xa, creads.ya, creads.za, creads.pitch, creads.roll,
          creads.yaw, creads.xm, creads.ym, creads.zm, creads.latitude,
          creads.longitude, creads.altitude, creads.speed, creads.heading);

  fclose(fp);

  sprintf(jsondata,
          "{\n\t\"temperature\":%-3.1f,\n\t\"humidity\":%-3.0f,"
          "\n\t\"pressure\":%-3.1f,\n\t\"xa\":%-f,\n\t\"ya\":%-f,\n\t\"za\":%-"
          "f,\\n\t\"pitch\":%-f,\n\t\"roll\":%-f,\n\t\"yaw\":%-f,\n\t\"xm\":%-"
          "f,\n\t\"ym\":%-f,\n\t\"zm\":%-f,\n\t\"latitude\":%-f,"
          "\n\t\"longitude\":%-f,\n\t\"altitude\":%-f,\n\t\"speed\":%-f,"
          "\n\t\"heading\":%-f,\n\t\"active\": true\n}",
          creads.rtime, creads.temperature, creads.humidity, creads.pressure,
          creads.xa, creads.ya, creads.za, creads.pitch, creads.roll,
          creads.yaw, creads.xm, creads.ym, creads.zm, creads.latitude,
          creads.longitude, creads.altitude, creads.speed, creads.heading);

  fp = fopen("loggerdata.json", "w");
  if (fp == NULL) {
    return -1;
  }

  fprintf(fp, jsondata);
  fclose(fp);
#else
  FILE *fp;
  char ltime[TIMESTRSZ];
  char jsondata[PAYLOADSTRSZ];

  fp = fopen("loggerdata.csv", "a");
  if (fp == NULL) {
    return 0;
  }

  strcpy(ltime, ctime(&creads.rtime));

  int commaIndex[] = {3, 7, 10, 19};

  for (int i : commaIndex) {
    ltime[i] = ',';
  }

  fprintf(fp,
          "%.24s,%3.1f,%3.0f,%3.1f,%f,%f,%f,%f,%f,%f,%f,%f,%f,%f,%f,%f,%f,%f\n",
          ltime, creads.temperature, creads.humidity, creads.pressure,
          creads.xa, creads.ya, creads.za, creads.pitch, creads.roll,
          creads.yaw, creads.xm, creads.ym, creads.zm, creads.latitude,
          creads.longitude, creads.altitude, creads.speed, creads.heading);

  fclose(fp);

  sprintf(jsondata,
          "{\n\t\"temperature\":%-3.1f,\n\t\"humidity\":%-3.0f,"
          "\n\t\"pressure\":%-3.1f,\n\t\"xa\":%-f,\n\t\"ya\":%-f,\n\t\"za\":%-"
          "f,\\n\t\"pitch\":%-f,\n\t\"roll\":%-f,\n\t\"yaw\":%-f,\n\t\"xm\":%-"
          "f,\n\t\"ym\":%-f,\n\t\"zm\":%-f,\n\t\"latitude\":%-f,"
          "\n\t\"longitude\":%-f,\n\t\"altitude\":%-f,\n\t\"speed\":%-f,"
          "\n\t\"heading\":%-f,\n\t\"active\": true\n}",
          creads.rtime, creads.temperature, creads.humidity, creads.pressure,
          creads.xa, creads.ya, creads.za, creads.pitch, creads.roll,
          creads.yaw, creads.xm, creads.ym, creads.zm, creads.latitude,
          creads.longitude, creads.altitude, creads.speed, creads.heading);

  fp = fopen("loggerdata.json", "w");
  if (fp == NULL) {
    return -1;
  }

  fprintf(fp, jsondata);
  fclose(fp);
#endif
  return 1;
}
void DlDisplayLogo() {
  uint16_t logo[8][8] = {
      HB, HB, HB, HB, HB, HB, HB, HB, HB, HB, HW, HB, HB, HW, HB, HY,
      HB, HB, HW, HB, HB, HW, HY, HY, HB, HB, HW, HB, HB, HW, HY, HY,
      HB, HB, HW, HW, HW, HW, HY, HY, HB, HB, HW, HY, HY, HW, HY, HY,
      HB, HY, HW, HY, HY, HW, HY, HY, HY, HY, HY, HY, HY, HY, HY, HY,
  };
  sh.WipeScreen();
  sh.ViewPattern(logo);
}
void DlUpdateLevel(float xa, float ya) {
  int x = (int)(ya * -30.0 + 4);
  int y = (int)(xa * -30.0 + 4);
  sh.WipeScreen();
  if (x < 0) {
    x = 0;
  } else if (x > 6) {
    x = 6;
  }

  if (y < 0) {
    y = 0;
  } else if (y > 6) {
    y = 6;
  }

  sh.LightPixel(x, y, HY);
  sh.LightPixel(x + 1, y, HY);
  sh.LightPixel(x, y + 1, HY);
  sh.LightPixel(x + 1, y + 1, HY);
}

void interruptHandler() {}