Dynamixel

Connect and control Robotis Dynamixel Servos to ARC. This open-source plugin converts the Virtual Servo ports on ARC (v0-v99) to control Robotis Dynamixel Servos.

Manual

Connect and control Robotis Dynamixel Servos with ARC, including Arduino and Robotis controllers. This open-source plugin converts the Virtual servo ports with any EZ-B (v0-v99) to control Robotis Dynamixel Servos. The servos supported are XL-320, AX-12, and XL430 compatible protocols. Dynamixel Servos are very different than regular hobby PWM servos. Firstly, they are considered much more professional due to their design which is specifically for use in robotics. Each Dynamixel servo contains a microprocessor. The microprocessor is told what position to move the servo into over TTL at the configured baud rate. 

ARC Capability Support
This robot skill supports native ARC servo parameters for Position, Acceleration, Velocity, and Speed

Cable Accessory
This plugin requires a cable accessory to easily connect your servo to the EZ-B. If you desire to READ servo positions, the cable will need to include both RX and TX. There are instructions below for connecting the servo to READ positioning.

EZB Controller Types

There are a few different types of EZB controllers, that each has its own hardware configuration. We cover the controllers and what UART should be used below.

EZ-Robot IoTiny
The IoTiny does not have a hardware UART, so it cannot read servo positions. This means you can use any of the digital ports to transmit servo positions to the servo. Connect any digital port of the IoTiny to the signal wire of the dynamixel connector.

Arduino/EZ-Robot EZB v4 Wiring For Reading Positioning
You must manually wire the servo yourself to these controllers using this diagram. If you wish to read servo data with bi-directional communication, you must connect TX and RX ports together. On the EZ-Robot EZ-B v4, it’s port D5 (TX) and D6 (RX) for UART #1 together. 





Robotis Open CM9.04 Controller
The Robotis Open CM9.04 controller can either support servos connected directly to itself or through the expansion board. If using only the controller, the UART #0 is used in ARC. If using the expansion board, UART #2 is used in ARC.

Robotis OpenCR Controller
The Robotis OpenCR controller can support servos connected directly to the onboard connectors. This uses UART #2 in ARC, which means select UART #2 in the dynamixel robot skill config.

UART/Serial Port Overview

There are a few options for connecting the Dynamixel servos that were covered above. Here is a summary...

1) EZB controllers without hardware UART (such as IoTiny) will use software serial pins for transmitting servo positions only. They cannot read servo positions. With this setup, you can use any digital port.

2) EZ-Robot EZ-B v4 or Arduino Mega is UART #1 (port D5 & D6). But depending on how many UARTs there EZB has, you can connect to any UART.

3) Robotis Open CM 9.04 without expansion board uses UART #0.

4) Robotis Open CM 9.04 with expansion board uses UART #2.

5) Robotis OpenCR uses UART #2.

Voltage

Most Dynamixel servo documentation states the operating voltage in the manual. Check the documentation for your dynamixel servo model to ensure your power source is sufficient. If you experience unusual behavior of Dynamixel servos, the first common issue is insufficient power. 

Servo ID

The Dynamixel Servos each have a unique ID. Because they are chained together through one cable, each servo must be given a unique ID. Servos with the same ID will respond to the same commands and therefore mirror their behavior. New Dynamixel Servos come pre-configured with the ID of 01. servo V0 relates to dynamixel ID:0, V1 is dynamixel ID:1, v2 is dynamixel ID:2, and so on...

Using this configuration utility, you can assign new ID's to servos. You may also test the servo to ensure the ID was successful.

Servo LEDs

The LEDs on the dynamixel servo can be controlled using the EZ-Script ControlCommand(). View the Cheat Sheet when editing a script to see the available ControlCommand syntax for the Dynamixel Plugin.

Control Commands

There are a number of control commands supported by this robot skill. The most useful are the WriteRam commands. These allow the user to send a command directly to the servo RAM. These control commands are not required to use this robot skill, as these are added for advanced users. To use the robot skill and move servos, simply follow the instructions in this manual page to assign Dynamixel servo id's to ARC Vx servos.

Code:

controlCommand("Dynamixel", "SetLED", Port, true|false);
controlCommand("Dynamixel", "TorqueEnable", Port, true|false);
controlCommand("Dynamixel", "WriteRamByte", Port, Address, Value);
controlCommand("Dynamixel", "WriteRamInt32", Port, Address, Value);
controlCommand("Dynamixel", "WriteRamUInt16", Port, Address, Value);

1) The Address and Value can be referenced using the servo Control Table. Find the list of Dynamixel Servos HERE to access their control table specifications.

2) Each WriteRam ControlCommand() specifies the size of the value. This is because control table addresses will require a value size (byte, int32, uint16). Check the manual for the control table command for the variable size it accepts.

For example, this command will set the goal position of an AX-12 servo on port V1 (id 1) to 512.

Code:

controlCommand("Dynamixel", "WriteRamUInt16", v1, 30, 512);

When viewing the control table, the parameters you will need for the control commands are identified in the image below. Notice the SIZE parameter, which determines the WriteRamXXXX to use. If the size is 1, the WriteRamByte will be used. If the size is 2, the WriteRamUInt16 will be used. If the size is 4, the WriteRamIn32 will be used. 

The address is and value range are also displayed in the control tables.

EZ-Script Commands

There are a number of EZ-Script commands added with this control. The commands are as follows...

Quote:

GetDynamixelTemp(ServoPort)
Returns the temp of the specified servo

GetDynamixelLoadDir(ServoPort)
Returns the direction of load on the specified servo

GetDynamixelLoad(ServoPort)
Returns the load of the specified servo

GetDynamixelPing(ServoPort)
Returns a ping response if the servo exists. Otherwise, returns false

Video Demo With Robotis Arm

This video uses a Robotis Dynamixel arm and XM430 servos with an OpenCM9.04 controller. 

Troubleshooting Dynamixel Servos

If the servos are not responding, verify the physical connection is correct. Next, verify adequate power is provided to the servo. Verify the servo ID and correct type is selected in this robot skill config.

If the XL430 or similar type servo is not responding, the torque may be disabled. This can be force enabled by using the control command, or by releasing the servo. When the servo is released, it will automatically enable torque once the servo is instructed to move.

Step by Step Instructions

Once you have the servo wired, and sufficient power is provided, you can use any control in ARC that uses servos. This means it will work with Auto Position, Camera, WiiMote, Joystick, and more. In this example, we'll show you how to move a dynamixel servo with generic servo control. Before following these steps, ensure you have this plugin installed.



Step 1
Load ARC






Step 2

Connect to your I/O controller






Step 3

Add the control by selecting the Project tab and Add Control






Step 4

Navigate to the servo tab and select Dynamixel. If the plugin has been successfully installed, you will see the Dynamixel plugin in the list.






Step 5

The Dyamixel control will be added to your project. Press the Config gear icon to load the configuration screen.






Step 6

Enter the baud rate that matches your servo configuration. The servos have a baud rate that can be specified or a default baud rate shipped from the factory. If you need to change the baud rate of the servo, use the Dyanmixel utility. You cannot change the baud rate of the servo in ARC. This value is the baud rate that the EZ-B will use to communicate with the dynamixel servo. This must match the baud rate of the servo.






Step 6a

Specify what port the servo is connected to on the controller. It is important to follow this recommendation. There are blue question boxes in the plugin (and throughout the ARC software) to assist your robot development. It is recommended to use the blue question marks and read the content to understand what options do.






Step 7

Each dynamixel servo will have a unique ID. Enable each ID for the servos by checking the respective box. When an ID is checked, the ARC software will use the Vx (virtual servos) corresponding with that ID. For example, if you enable Dynamixel servo ID #2, the ARC V2 servo will control it. Also, specify the protocol version of the servo. Different dynamixel models will use one of the two protocols. Consult the datasheet of the dynamixel servo to know what protocol it uses -or- contact Robotis for more information on using their product. To get full resolution of the servo, also ensure you have entered the MAX resolution for that servo model. Each model has different resolutions, or it can be configured using the Dyanmixel utilities.






Step 8

After you have enabled your servos, press Save






Step 9

Now we will show you an example of how the servo can be moved. We will do this by using a generic horizontal servo control. Press Project -> Add Control to return to the add control menu. Navigate to servo and select Horizontal Servo. Remember, any control in ARC that uses servos can now control dynamixel servos by the respective Vx (virtual) servo ID.






Step 10

Press the GEAR icon to configure the horizontal servo control.






Step 11

To configure this control to use a virtual servo, select the servo to bring up the port dialog. This applies to all controls in ARC that use servos.






Step 12

Select the Virtual servo ID for your dynamixel servo from the list and press Close.






Step 13

Now use the sliders to specify the Min and Max position that you wish this servo to move and press Close.






Finished

You can now control the dynamixel servo with the horizontal servo control. To find out more about servos, consult the learn section of this website for activities on using your Synthiam product.

controlCommand("Dynamixel", "SetLED", V2, true);
controlCommand("Dynamixel", "WriteRamInt32", V2, 112, 10);

// Simple Script to change the acceleration and velocity on two XM540-W150-R
// This script works on most x series 500 and 400 Dynamixels.. Check control
// table at Robotis wesite to make sure your servos use these same control codes
// Note acceleration value should be half or less of the velocity value.
// Max values allowed vary from servo to servo (see control table for more info)
// A lower acceleration value gives a more sluggish but more dampened motion
// values of 0 = max value so setting both acceleration and velocity 
// to 0 gives you full speed with no dampening
// Acceleration and velocity values should just be set as needed and not constantly within a loop

//change velocity on servo 1 to 75 (profile velocity control code is 112)
controlCommand("Dynamixel", "WriteRamInt32", V1, 112, 75);
//change acceleration on servo 1 to 10 (profile velocity control code is 108)
controlCommand("Dynamixel", "WriteRamInt32", V1, 108, 10);

controlCommand("Dynamixel", "WriteRamInt32", V2, 112, 75);
controlCommand("Dynamixel", "WriteRamInt32", V2, 108, 10);

// This script works on most x series 500 and 400 Dynamixels.. Check control
// table at Robotis wesite to make sure your servos use these same control codes
// Note acceleration value should be half or less of the velocity value.
// Max values allowed vary from servo to servo (see control table for more info)
// A lower acceleration value gives a more sluggish but more dampened motion
// values of 0 = max value so setting both acceleration and velocity 
// to 0 gives you full speed with no dampening
// Acceleration and velocity values should just be set as needed and not constantly within a loop

//change velocity on servo 1 to 75 (profile velocity control code is 112)
controlCommand("Dynamixel", "WriteRamInt32", V1, 112, 75);
//change acceleration on servo 1 to 10 (profile velocity control code is 108)
controlCommand("Dynamixel", "WriteRamInt32", V1, 108, 10);

controlCommand("Dynamixel", "WriteRamInt32", V2, 112, 75);
controlCommand("Dynamixel", "WriteRamInt32", V2, 108, 10);

controlCommand("Dynamixel", "SetLED", V1, false);
controlCommand("Dynamixel", "TorqueEnable", V1, true);

controlCommand("Dynamixel", "SetLED", V2, true);
controlCommand("Dynamixel", "TorqueEnable", V2, true);

controlCommand("Dynamixel", "WriteRamByte", V1, 64, 1);