#include <Wire.h>
#include <Ambient.h>

//アドレス指定
#define ADXL345_ADDR 0x53
#define DATA_FORMAT 0x31
#define POWER_CTL 0x2D
#define DATAX0 0x32
#define FULL_RES_16G 0x0B
#define BIT10_16G 0x03
#define MEASURE 0x08
WiFiClient client;
Ambient ambient; // Ambientオブジェクトを定義

//ESP32におけるADXL345加速度センサ使用てすと

const char ssid = "74D21DBC979A-2G";
const char password = "55351101652577";

unsigned int channelId = 37697; // AmbientのチャネルID
const char* writeKey = "3d1a0875f4a46513"; // ライトキー

void setup() {

 Wire.begin();//I2Cを初期化
  Serial.begin(115200);//シリアル通信を115200bpsで初期化
  delay(100);

 WiFi.begin(ssid, password);  //  Wi-Fi APに接続
    while (WiFi.status() != WL_CONNECTED) {  //  Wi-Fi AP接続待ち
        delay(100);
    }

   Serial.print("WiFi connected\r\nIP address: ");
    Serial.println(WiFi.localIP());

 pinMode(21, INPUT_PULLUP); //デファルトのSDAピン21　のプルアップの指定
  pinMode(22, INPUT_PULLUP); //デファルトのSDAピン22　のプルアップの指定

 ambient.begin(channelId, writeKey, &client); // チャネルIDとライトキーを指定してAmbientの初期化

 Wire.beginTransmission(ADXL345_ADDR);//I2Cスレーブのデータ送信開始
  Wire.write(DATA_FORMAT);//データ・フォーマット・コントロール
  Wire.write(FULL_RES_16G);//「最大分解能モード」、「±16g」
  //Wire.write(BIT10_16G);//「10bit固定分解能モード」、「±16g」
  Wire.endTransmission();//I2Cスレーブのデータ送信終了

 Wire.beginTransmission(ADXL345_ADDR);//I2Cスレーブのデータ送信開始
  Wire.write(POWER_CTL);//省電力機能コントロール
  Wire.write(MEASURE);//測定モード
  Wire.endTransmission();//I2Cスレーブのデータ送信終了
}

void loop() {
  unsigned int dac[6];
  unsigned int i, x, y, z;
  float X_Axis, Y_Axis, Z_Axis, XYZ_Axis;

 Wire.beginTransmission(ADXL345_ADDR);//I2Cスレーブのデータ送信開始
  Wire.write(DATAX0);//出力データバイトを「X軸データ0」のアドレスに指定
  Wire.endTransmission();//I2Cスレーブのデータ送信終了
  
  Wire.requestFrom(ADXL345_ADDR, 6);//I2Cデバイス「ADXL345」に6Byteのデータ要求
  for (i=0; i<6; i++){
    while (Wire.available() == 0 ){}
    dac[i] = Wire.read();//dacにI2Cデバイス「ADXL345」のデータ読み込み
  }

 x = (dac[1] << 8) | dac[0];//2Byte目のデータを8bit左にシフト、OR演算子で1Byte目のデータを結合して、xに代入
  X_Axis = float(x)  0.0392266;//加速度の計算、X_Axisに代入 ※0.0392266=(4/1000*9.80665)
  y = (dac[3] << 8) | dac[2];//2Byte目のデータを8bit左にシフト、OR演算子で1Byte目のデータを結合して、xに代入
  Y_Axis = float(y)  0.0392266;//加速度の計算、Y_Axisに代入
  z = (dac[5] << 8) | dac[4];//2Byte目のデータを8bit左にシフト、OR演算子で1Byte目のデータを結合して、xに代入
  Z_Axis = float(z) * 0.0392266;//加速度の計算、Z_Axisに代入
  XYZ_Axis = (X_Axis + Y_Axis + Z_Axis) / 3;
  
  Serial.print("X-Axis ");//文字列「X.」をシリアルモニタに送信
  Serial.print(X_Axis);//「X_Axis」をシリアルモニタに送信
  Serial.print(" m/s^2 ");//文字列「m/s^2」をシリアルモニタに送信
  Serial.print("Y-Axis ");//文字列「Y.」をシリアルモニタに送信
  Serial.print(Y_Axis);//「Y_Axis」をシリアルモニタに送信
  Serial.print(" m/s^2 ");//文字列「m/s^2」をシリアルモニタに送信
  Serial.print("Z-Axis ");//文字列「Z.」をシリアルモニタに送信
  Serial.print(Z_Axis);//「Z_Axis」をシリアルモニタに送信
  Serial.print(" m/s^2");//文字列「m/s^2」をシリアルモニタに送信、改行
  Serial.println(XYZ_Axis);//「Z_Axis」をシリアルモニタに送信

 ambient.set(1,X_Axis);
  ambient.set(2,Y_Axis);
  ambient.set(3,Z_Axis);

 ambient.send();
   
  delay(1000);//1000msec待機(1秒待機)
}