 #endif
 
   prev_error = error;
+
+  endTime = millis();
+  Serial.println(' ');
+  Serial.println(startTime - endTime);
 }
 //END LOOP
 

float LPFilter(float input, float pre_result);
void sendProcessing();

unsigned char total_rotate[8] = {0,};
// the cs pin of the version after v1.1 is default to D9
// v0.9b and v1.0 is default D10

  Serial.begin(9600);
  pinMode(5, INPUT);
  pinMode(6, INPUT);
  pinMode(12, OUTPUT);
  int CANStart = CAN.begin(CAN_500KBPS);
  if (!CANStart)
    Serial.println("CAN BUS Shield init ok!");
