#include <P1AM.h>

#include <SimpleTimer.h>

const char configData[2] = {0x40, 0x03};

float elongation;

float load;

SimpleTimer timer;

void flushBuffer()

{ 

 Serial.flush();       // flush serial buffer (may not always flush?)

 while (Serial.available())  // manually empty as well, read as long as bytes in there

  Serial.read();

}

void read1(){

flushBuffer();

 elongation = P1.readAnalog(1, 1); //Reads analog data from slot 1 channel 1 of the analog input module

Serial.print("!O elongation= ");

Serial.println(elongation);

 load = P1.readAnalog(1, 2); //Reads analog data from slot 1 channel 2 of the analog input module

Serial.print("!O load= ");

Serial.println(load);

}

void graph(){

 Serial.print(elongation);

 Serial.print(",");

 Serial.println(load);

}

void setup(){ // the setup routine runs once:

 Serial.begin(9600); //initialize serial communication at 9600 bits per second 

 while (!P1.init()){ 

  ; //Wait for Modules to Sign on  

 }

 P1.configureModule(configData, 1);

  timer.setInterval(1000L, read1);

  timer.setInterval(1000L, graph);

}

void loop(){ // the loop routine runs over and over again forever:

timer.run();

}