   {
     CMD_SERIAL.println("    ... SUCCESS");
     CMD_SERIAL.printf("    [ID: %d found at baud: %d]\n", id, tb3_baud );
+    portHandler->setBaudRate(tb3_baud);
     return true;
   }
 

#define PROTOCOL_VERSION2               2.0

// Default setting
#define DEVICENAME                      "/dev/OpenCR"       // Check which port is being used on your controller
// ex) Windows: "COM1"   Linux: "/dev/ttyUSB0"
#define CMD_SERIAL                      Serial              // USB Serial


  }

  return ret;
}
