 
   double temperature = (double)tempRaw / 340.0 + 36.53;
   Serial.print(temperature); Serial.print("\t");
-#endif
-
   Serial.print("\r\n");
-  delay(2);
-}
+#endif
+  //delay(2);
+}

int control_decision = 0;
double error = 0;
double delta_error = 0;


void setup() {

}

void loop() {
  digitalWrite(5, LOW);
  Serial.print(motor_speed * A_trend_first);
  Serial.print(' ');
  Serial.println(motor_speed2 * A_trend_first2);
  digitalWrite(5, HIGH);
  /* Update all the values */
  while (i2cRead(0x3B, i2cData, 14));
  accX = ((i2cData[0] << 8) | i2cData[1]);
