 
 // Runnable for fsrThread
 void readPressure(){
+  countFSRThread++;
   int frontRight = analogRead(PRESSURE_0)*5;
   int frontLeft = analogRead(PRESSURE_1)*5;
   int backRight = analogRead(PRESSURE_2)*5;

  Serial.println("1 : "+ String(frontLeft));
  Serial.println("2 : "+ String(backRight));
  Serial.println("3 : "+ String(backLeft));

  // send 'posture msg' to android
  if(frontRight>2000){
    BTSerial.println("fr");
  }
  if(frontLeft>2000){
    BTSerial.println("fl");
  }
  if(backRight>2000){
    BTSerial.println("br");
  }
  if(backLeft>2000){
    BTSerial.println("bl");
  }
}

void readTmp(){
    digitalWrite(MOSFET_C1,HIGH);
    Serial.println("temperature on"));  
}


#define TMP_OFF "f"

Thread fsrThread = Thread(); // For measuring Pressure data in other thread

int countFSRThread = 0;
int count_0 = 0;
int count_1 = 0;
int count_2 = 0;
int count_3 = 0;    

int initPosture_0;
int initPosture_1;
int initPosture_2;
int initPosture_3;

float percentage = 0.25; 

//  Mosfet channel
int MOSFET_C1 = 10;
