// スマートインソール：FSR4ch読み取り＋SDカードへCSV記録
#include <SPI.h>
#include <SD.h>
// --- ピン設定 ---
const int FSR_PINS[] = {A0, A1, A2, A3};   // CH1踵中央, CH2踵外側, CH3母趾球, CH4小趾球
const int CH_COUNT = 4;
const int SD_CS_PIN = 10;
const int LED_PIN = 8;
// --- サンプリング設定 ---
const unsigned long SAMPLE_INTERVAL_MS = 20;  // 50Hz
unsigned long lastSampleTime = 0;
unsigned long sampleIndex = 0;
// --- 踵接地しきい値（要調整：まず生の値を見てから決める） ---
const int HEEL_STRIKE_THRESHOLD = 300;   // CH1(踵中央)がこの値を超えたら接地とみなす
bool wasHeelDown = false;
File logFile;
void setup() {
  Serial.begin(115200);
  pinMode(LED_PIN, OUTPUT);
  pinMode(SD_CS_PIN, OUTPUT);
  if (!SD.begin(SD_CS_PIN)) {
    Serial.println("SD init failed");
    // SDが無くてもシリアルモニタで確認できるよう、処理は止めない
  } else {
    logFile = SD.open("gait_log.csv", FILE_WRITE);
    if (logFile) {
      logFile.println("time_ms,ch1_heel_c,ch2_heel_o,ch3_mtp1,ch4_mtp5,heel_strike");
      logFile.close();
    }
  }
  digitalWrite(LED_PIN, HIGH);  // 記録開始の合図
}
void loop() {
  unsigned long now = millis();
  if (now - lastSampleTime < SAMPLE_INTERVAL_MS) {
    return;  // まだサンプリングのタイミングではない
  }
  lastSampleTime = now;
  int values[CH_COUNT];
  for (int i = 0; i < CH_COUNT; i++) {
    values[i] = analogRead(FSR_PINS[i]);
  }
  // 踵接地判定：CH1がしきい値を上回った瞬間（立ち上がりエッジ）だけ検出する
  bool heelDownNow = values[0] > HEEL_STRIKE_THRESHOLD;
  bool heelStrikeEvent = heelDownNow && !wasHeelDown;
  wasHeelDown = heelDownNow;
  // シリアルモニタへ出力（配線確認・しきい値決めに使う）
  Serial.print(now);
  Serial.print(",");
  for (int i = 0; i < CH_COUNT; i++) {
    Serial.print(values[i]);
    Serial.print(",");
  }
  Serial.println(heelStrikeEvent ? "1" : "0");
  // SDカードへCSV追記
  logFile = SD.open("gait_log.csv", FILE_WRITE);
  if (logFile) {
    logFile.print(now);
    logFile.print(",");
    for (int i = 0; i < CH_COUNT; i++) {
      logFile.print(values[i]);
      logFile.print(",");
    }
    logFile.println(heelStrikeEvent ? "1" : "0");
    logFile.close();
  }
  if (heelStrikeEvent) {
    digitalWrite(LED_PIN, LOW);
    delay(15);  // 目視できる程度の短い点滅（サンプリングへの影響は軽微）
    digitalWrite(LED_PIN, HIGH);
  }
  sampleIndex++;
}