 
     unsigned int canId = CAN.getCanId();
     
+    // Serial.print("Current: ");
+    
+    //   for(int i = 0; i<len; i++)    // print the data
+    //     {
+    //         Serial.print(buf[i], HEX);
+    //         Serial.print("\t");
+    //     }
+    // Serial.println();
+
+    current_data = buf[4];
+    current_data <<= 8;
+    current_data = current_data | buf[5];
+    current_data <<= 8;
+    current_data = current_data | buf[6];
+    current_data <<= 8;
+    current_data = current_data | buf[7];
+
     Serial.print("Current: ");
-    Serial.println(buf);
+    Serial.println(current_data);
 
     return(current_data);
   }

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

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

    return(encoder_data);
  }

float currentDataRead()
{

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