Robotis Dynamixel Pro Quick Start Manual page 98

Quick Start for Dynamixel Pro v1.00b
//Open the port of USB2DXL
if(dxl_initialize(Port, COM_PORT_NUM, BAUD_RATE_NUM) ==
COMM_RXSUCCESS )
printf("Succeed to open
else
{
printf(
printf(
_getch();
return
}
int Result;
unsigned char
param[0] = ID_1;
param[1] = 255;
param[2] = ID_2;
param[3] = 255;
param[4] = ID_3;
param[5] = 255;
//LED On
printf( "Press any to turn on the LED...\n"
_getch();
Result = dxl_sync_write(Port, P_LED_RED, 1, param, 6);
if( Result != COMM_RXSUCCESS )
{
printf(
printf(
_getch();
return
}
param[0] = ID_1;
param[1] = 0;
param[2] = ID_2;
param[3] = 0;
param[4] = ID_3;
param[5] = 0;
//LED Off
printf( "Press any to turn off the LED...\n"
_getch();
Result = dxl_sync_write(Port, P_LED_RED, 1, param, 6);
if( Result != COMM_RXSUCCESS )
{
printf(
printf(
_getch();
USB2Dynamixel!\n");
"Failed to open USB2Dynamixel!\n"
"Press any key to terminate...\n"
0;
param[6];
"Failed to write!\n" );
"Press any key to terminate...\n"
0;
"Failed to write!\n" );
"Press any key to terminate...\n"
);
);
);
);
);
);
Page 98 / 139