     Serial.println(" Init CAN BUS Shield again");
     delay(100);
   }
+  State = Startup;
   Serial.println("CAN BUS Shield init ok!");
 }
 


void loop()
{
  State = Startup;

  switch (State) 
  {
    case Startup:
      do doStartup();
      break;
    case Operational:
      dataRead();

  unsigned char buf[8];

    Serial.println("Enviei a mensagem");
    // Serial.println(setpoint_position,HEX);
    // clear the string:
    CAN.sendMsgBuf(0x601, 0, 8, setpoint_position);
    delay(10);
