SmartInsoles

#include <CapPin.h>
#include <SPI.h>
#include <boards.h>
#include <services.h>
#include <ble_mini.h>
#define FSR_SENSE A7

CapPin cPin_10 = CapPin(12);    // read pin 10 (D10 on Flora) - connect to NES B
CapPin cPin_9  = CapPin(9);
CapPin pins[] = {
  cPin_10, cPin_9};

unsigned long currentMillis;        // store the current value from millis()
unsigned long previousMillis;       // for comparison with currentMillis
int samplingInterval = 0;          // how often to run the main loop (in ms)

void setup(){
  BLEMini_begin(57600);
  Serial.begin(57600);
}

void loop() {

  while(BLEMini_available()==3) {
   
    byte pinColor=BLEMini_read();
    byte pinState=BLEMini_read();
    //delay(20);
    Serial.println("Pushing Data");
    /*Serial.println(pinColor);
     Serial.println(pinState);*/
    switch (pinColor){
    case 0xA7:
      {
        uint16_t fsrRead = analogRead(FSR_SENSE);
        //Serial.println(fsrRead);
        BLEMini_write(0x0B);
        BLEMini_write(fsrRead >> 8);
        BLEMini_write(fsrRead);
        delay (10);
       // Serial.println("WE ARE HERE 1");
        break;
      }
    case 0xAB:
      {
        uint16_t frontFoot =  pins[0].readPin(2000);
         BLEMini_write(0x0B);
         BLEMini_write(frontFoot >> 8);
         BLEMini_write(frontFoot);
         delay(10);
        break;
      }
    case 0xA9:
      {
       uint16_t  backFoot  = pins[1].readPin(2000);
         BLEMini_write(0x0B);
         BLEMini_write(backFoot >> 8);
         BLEMini_write(backFoot);
         delay(10);
        break;
      }
    }

  }

}