ESP32-PaxCounter/src/sensor.cpp

// Basic Config
#include "globals.h"

// Local logging tag
static const char TAG[] = __FILE__;

#define SENSORBUFFER                                                           \
  10 // max. size of user sensor data buffer in bytes [default=20]

void sensor_init(void) {

  // this function is called during device startup
  // put your user sensor initialization routines here
}

uint8_t sensor_mask(uint8_t sensor_no) {
  switch (sensor_no) {
  case 0:
    return (uint8_t)COUNT_DATA;
  case 1:
    return (uint8_t)SENSOR1_DATA;
  case 2:
    return (uint8_t)SENSOR2_DATA;
  case 3:
    return (uint8_t)SENSOR3_DATA;
  case 4:
    return (uint8_t)BATT_DATA;
  case 5:
    return (uint8_t)GPS_DATA;
  case 6:
    return (uint8_t)MEMS_DATA;
  case 7:
    return (uint8_t)ALARM_DATA;
  default:
    return 0;
  }
}

uint8_t *sensor_read(uint8_t sensor) {

  static uint8_t buf[SENSORBUFFER] = {0};
  uint8_t length = 3;

  switch (sensor) {

  case 1:

    buf[0] = length;
    buf[1] = 0xff;
    buf[2] = 0xa0;
    buf[3] = 0x01;
    break;

  case 2:

    buf[0] = length;
    buf[1] = 0xff;
    buf[2] = 0xa0;
    buf[3] = 0x02;
    break;

  case 3:

    buf[0] = length;
    buf[1] = 0xff;
    buf[2] = 0xa0;
    buf[3] = 0x03;
    break;
  }

  return buf;
}