             Serial.print("\t");
         }
         Serial.println();
+        DataReadState = Position_State;
+        }
         break;
-      case 0x381:
-        Serial.println("-----------------------------");
-        Serial.print("POSICAO: ");
-        Serial.println(canId, HEX);
-
-        for(int i = 0; i<len; i++)    // print the data
+      case Position_State:
+        if(canId == 0x181)
         {
-            Serial.print(buf[i], HEX);
-            Serial.print("\t");
+          Serial.println("-----------------------------");
+          Serial.print("POSICAO: ");
+          Serial.println(canId, HEX);
+
+          for(int i = 0; i<len; i++)    // print the data
+          {
+              Serial.print(buf[i], HEX);
+              Serial.print("\t");
+          }
+          Serial.println();
+          DataReadState = Amplification_State;
         }
-        Serial.println();
         break;
-      case 0x321:
-        Serial.println("-----------------------------");
-        Serial.print("AMPLIFICACAO: ");
-        Serial.println(canId, HEX);
-
-        for(int i = 0; i<len; i++)    // print the data
+      case Amplification_State:
+        if(canId == 0x321)
         {
-            Serial.print(buf[i], HEX);
-            Serial.print("\t");
+          Serial.println("-----------------------------");
+          Serial.print("AMPLIFICACAO: ");
+          Serial.println(canId, HEX);
+
+          for(int i = 0; i<len; i++)    // print the data
+          {
+              Serial.print(buf[i], HEX);
+              Serial.print("\t");
+          }
+          Serial.println();
+          DataReadState = Current_State;
         }
-        Serial.println();
         break;
       }
   }

#define Pre_Operational     2
#define Operational         3

// Statemachine State variable and initial value
byte State = Startup;

// the cs pin of the version after v1.1 is default to D9
// v0.9b and v1.0 is default D10

  {
    CAN.readMsgBuf(&len, buf);    // read data,  len: data length, buf: data buf
    unsigned int canId = CAN.getCanId();
    Serial.println("Entrou Leitura");

    switch (DataReadState) 
    {        
      case Current_State:
        Serial.println("Entrou Current State");
        if(canId == 0x381) 
        {
        Serial.println("-----------------------------");
        Serial.print("CORRENTE: ");
        Serial.println(canId, HEX);
