       doStartup();
       break;
     case Operational:
-      dataRead();
+      amplificationBoardDataRead();
+      currentdataRead(current_data);
       positionSetpoint(encoder_data);
       break;
   }

//    Serial.print("Encoder: ");
//    Serial.println(encoder_data, DEC);

    Serial.print("Loadcell: ");
    Serial.println(loadcell_data_double);

    return(encoder_data);
  }

}

//***************
// DATA READ
//***************
float amplificationBoardDataRead()
{
  unsigned char len = 0;
  unsigned char buf[8];
