 
   if (tb3_id < 0)
   {
-       CMD_SERIAL.println("    no dxl motors");
-  }
-  else
-  {
-    write(portHandler, packetHandler2, tb3_id,64, 1, 0);
+    CMD_SERIAL.println("    no dxl motors");
+  }
+  else
+  {
+    write(portHandler, packetHandler2, tb3_id, 64, 1, 0);
     write(portHandler, packetHandler2, tb3_id, 7, 1, 1);
     tb3_id = 1;
     write(portHandler, packetHandler2, tb3_id, 8, 1, 3);


  CMD_SERIAL.print("Do you really want to setup ? y/n : ");

  while(1)
  {
    if (CMD_SERIAL.available())
    {


  if (tb3_id < 0)
  {
    CMD_SERIAL.println("    no dxl motors");
  }
  else
  {
    write(portHandler, packetHandler2, tb3_id, 64, 1, 0);
    write(portHandler, packetHandler2, tb3_id, 7, 1, 2);
    tb3_id = 2;
    write(portHandler, packetHandler2, tb3_id, 8, 1, 3);
