 ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
 // How to run it: upload to arduino with the dynamixel_serial library installed in your arduino libraries folder.             //
 //                After upload, disconnect usb from arduino and add power to CrustCrawler and the arduino board.              //
-//                The program should start by it self. :)                                                                     //
+//                The program should start by it self. :)
 //                                                                                                                            //
 //                PIN Setup:  Green wire to PIN 10,                                                                           //
 //                            Yellow wire to PIN 11,                                                                          //


  // Set the Profile acceleration.
  Dynamixel.setProfileAcceleration(0x01, 10);  //Set the Profile Acceleration for each servo. (max. is 32767)
  Dynamixel.setProfileAcceleration(0x02, 10);  //Set the Profile Acceleration for each servo. (max. is 32767)
  Dynamixel.setProfileAcceleration(0x03, 10);  //Set the Profile Acceleration for each servo. (max. is 32767)
  /*
  Dynamixel.setProfileAcceleration(0x04, 300);  //Set the Profile Acceleration for each servo. (max. is 32767)
  Dynamixel.setProfileAcceleration(0x05, 300);  //Set the Profile Acceleration for each servo. (max. is 32767)
  */

  // Set the Profile velocity.
  Dynamixel.setProfileVelocity(0x01, 100);  //Set the Profile Velocity for each servo. (max. is 1023)
  Dynamixel.setProfileVelocity(0x02, 100);  //Set the Profile Velocity for each servo. (max. is 1023)
  Dynamixel.setProfileVelocity(0x03, 100);  //Set the Profile Velocity for each servo. (max. is 1023)
  /*
  Dynamixel.setProfileVelocity(0x04, 200);  //Set the Profile Velocity for each servo. (max. is 1023)
  Dynamixel.setProfileVelocity(0x05, 200);  //Set the Profile Velocity for each servo. (max. is 1023)
  */


  /*
  //Get position for servos in steps
  Dynamixel.getPosition(0x01); 
  Dynamixel.getPosition(0x02);

    Serial.println(data[i]);
  }


}


