#include <bluefruit.h>
#include "nrf_rtc.h"
#include "ClosedCube_MAX30205.h"

#define LED_BUILTIN 3

ClosedCube_MAX30205 max30205;
const int max30205Pin = 10;         //max30205の電源にするためのピン

BLEUart bleuart; // uart over ble

#define DEVICE_NAME "nRF52_bodyTemp"
#define DEVICE_NUMBER 1

void setup() {
  pinMode(max30205Pin, OUTPUT);
  pinMode(LED_BUILTIN, OUTPUT);

  digitalWrite(max30205Pin, LOW);
  
  delay(1000*60);//1min ~950uA
  startAdv();
}


void startAdv(void)
{
   float temp;
   int dataCount=0;
   
  //i2cの準備 測定
  digitalWrite(max30205Pin, HIGH);
  delay(100);
  max30205.begin(0x48);
  temp = max30205.readTemperature();

  digitalWrite(max30205Pin, LOW);

  // Config the peripheral connection with maximum bandwidth
  Bluefruit.configPrphBandwidth(BANDWIDTH_MAX);

  Bluefruit.begin();
  Bluefruit.setTxPower(4);    // Check bluefruit.h for supported values
  Bluefruit.setName(DEVICE_NAME);

  // Advertising packet
  Bluefruit.Advertising.addFlags(BLE_GAP_ADV_FLAGS_LE_ONLY_GENERAL_DISC_MODE);
  Bluefruit.Advertising.addTxPower();
  Bluefruit.Advertising.addService(bleuart);// Include bleuart 128-bit uuid

  Bluefruit.ScanResponse.addName();

  uint8_t msd_payload[5]; //送信データサイズ　5バイト

  int tempInt = temp * 100;//温度を100倍して整数に


  msd_payload[0] = 0xff;                        // manufacturer ID TEST device
  msd_payload[1] = 0xff;                        // manufacturer ID TEST device
  msd_payload[2] = (char)DEVICE_NUMBER;         // デバイス番号 2
  msd_payload[3] = (char)(tempInt & 0xff);         // 温度の下位バイト 3
  msd_payload[4] = (char)((tempInt >> 8) & 0xff);  // 温度の上位バイト 4

  Bluefruit.Advertising.addData(BLE_GAP_AD_TYPE_MANUFACTURER_SPECIFIC_DATA, msd_payload, sizeof(msd_payload));

  Bluefruit.Advertising.restartOnDisconnect(true);
  Bluefruit.Advertising.setInterval(32, 244);    // in unit of 0.625 ms
  Bluefruit.Advertising.setFastTimeout(3);      // number of seconds in fast mode
  Bluefruit.Advertising.start(2);                // 0 = Don't stop advertising after n seconds 5秒間BLEの信号出して止まる
}


void loop() {
  digitalWrite(LED_BUILTIN, HIGH);
  delay(500);
  digitalWrite(LED_BUILTIN, LOW);


  NVIC_SystemReset();
}