       doStartup();
       break;
     case Operational:
-      amplificationBoardDataRead();
-      currentdataRead(current_data);
-      positionSetpoint(encoder_data);
+//      amplificationBoardDataRead();
+      currentDataRead();
+//      positionSetpoint(encoder_data);
       break;
   }
   delay(100);

// ***************************
// EPOS2 CANOpen Communication
// ***************************

// Statemachine
unsigned char set_pre_operational[2] = {0x80, 0};

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

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

    return(encoder_data);
  }
}

float currentDataRead()
{
