#include <Wire.h>
#include <FDC2214.h>
FDC2214 capsense(FDC2214_I2C_ADDR_0); // Use FDC2214_I2C_ADDR_1

// ###
void setup() {

  // ### Start I2C
  Wire.begin();
  //Wire.setClock(40000L);

  // ### Start serial
  Serial.begin(115200);
  Serial.println("\nFDC2x1x test");

  // ### Start FDC
  // Start FDC2212 with 2 channels init
  //bool capOk = capsense.begin(0x3, 0x4, 0x5); //setup first two channels, autoscan with 2 channels, deglitch at 10MHz
  // Start FDC2214 with 4 channels init
  bool capOk = capsense.begin(0xF, 0x4, 0x5); //setup all four channels, autoscan with 2 channels, deglitch at 10MHz
  if (capOk) Serial.println("Sensor OK");
  else Serial.println("Sensor Fail");

}

// ### Tell aplication how many chanels will be smapled in main loop
#define CHAN_COUNT 4

// ###
void loop() {
  unsigned long capa[CHAN_COUNT]; // variable to store data from FDC
  for (int i = 0; i < CHAN_COUNT; i++){ // for each channel
    // ### read 28bit data
    capa[i]= capsense.getReading16(i); //Changed this to 16 for fdc2114
    // ### Transmit data to serial in simple format readable by SerialPlot application.
    Serial.print(capa[i]);
    if (i < CHAN_COUNT-1) Serial.print(", ");
    else Serial.println("");
  }
  // No point in sleeping
  delay(100);
}