     //     }
     // Serial.println();
 
-    current_data = buf[4];
+    current_data = buf[2];
     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: ");
+    current_data = current_data | buf[3];
+    // current_data <<= 8;
+    // current_data = current_data | buf[6];
+    // current_data <<= 8;
+    // current_data = current_data | buf[7];
+
     Serial.println(current_data);
 
     return(current_data);


    unsigned int canId = CAN.getCanId();
    
    // Serial.print("Current: ");
    
    //   for(int i = 0; i<len; i++)    // print the data
    //     {

unsigned char disable_epos[8] = {0x2B, 0x40, 0x60, 0, 0x06, 0, 0, 0};

// PDO Configuration
unsigned char pdo_sync[1] = {0x00};

unsigned char pdo_actual_position_1[8] = {0x22, 0x02, 0x18, 0x01, 0x81, 0x03, 0, 0};
unsigned char pdo_actual_position_2[8] = {0x22, 0x02, 0x18, 0x02, 0x01, 0, 0, 0};
