dynamixel.groupBulkReadAddParam(groupread_num, DXL2_ID, ADDR_PRO_LED_RED,
LEN_PRO_LED_RED)).value
if dxl_addparam_result != 1:
print("[ID:%03d] groupBulkRead addparam failed" % (DXL2_ID))
quit()
while 1:
print("Press any key to continue! (or press ESC to quit!)")
if getch() == chr(ESC_ASCII_VALUE):
break
# Add parameter storage for Dynamixel#1 goal position
dxl_addparam_result = ctypes.c_ubyte(
dynamixel.groupBulkWriteAddParam(groupwrite_num, DXL1_ID,
ADDR_PRO_GOAL_POSITION,
LEN_PRO_GOAL_POSITION,
dxl_goal_position[index],
LEN_PRO_GOAL_POSITION)).value
if dxl_addparam_result != 1:
fprintf(stderr, "[ID:%03d] groupBulkWrite addparam failed", DXL1_ID)
quit()
# Add parameter storage for Dynamixel#2 LED value
dxl_addparam_result = ctypes.c_ubyte(
dynamixel.groupBulkWriteAddParam(groupwrite_num, DXL2_ID,
ADDR_PRO_LED_RED, LEN_PRO_LED_RED,
dxl_led_value[index],
LEN_PRO_LED_RED)).value
if dxl_addparam_result != 1:
fprintf(stderr, "[ID:%03d] groupBulkWrite addparam failed", DXL2_ID)
quit()
quit()
# Add parameter storage for Dynamixel#2 present moving value
dxl_addparam_result = ctypes.c_ubyte(dynamixel.groupBulkReadAddParam(groupread_num, DXL2_ID, ADDR_PRO_LED_RED, LEN_PRO_LED_RED)).value
if dxl_addparam_result != 1:
print("[ID:%03d] groupBulkRead addparam failed" % (DXL2_ID))
quit()
while 1:
print("Press any key to continue! (or press ESC to quit!)")
if getch() == chr(ESC_ASCII_VALUE):
break
# Add parameter storage for Dynamixel#1 goal position
dxl_addparam_result = ctypes.c_ubyte(dynamixel.groupBulkWriteAddParam(groupwrite_num, DXL1_ID, ADDR_PRO_GOAL_POSITION, LEN_PRO_GOAL_POSITION, dxl_goal_position[index], LEN_PRO_GOAL_POSITION)).value
if dxl_addparam_result != 1:
fprintf(stderr, "[ID:%03d] groupBulkWrite addparam failed", DXL1_ID)
quit()
# Add parameter storage for Dynamixel#2 LED value
dxl_addparam_result = ctypes.c_ubyte(dynamixel.groupBulkWriteAddParam(groupwrite_num, DXL2_ID, ADDR_PRO_LED_RED, LEN_PRO_LED_RED, dxl_led_value[index], LEN_PRO_LED_RED)).value
if dxl_addparam_result != 1:
fprintf(stderr, "[ID:%03d] groupBulkWrite addparam failed", DXL2_ID)
quit()
# Bulkwrite goal position and LED value
dynamixel.groupBulkWriteTxPacket(groupwrite_num)
dxl_comm_result = dynamixel.getLastTxRxResult(port_num, PROTOCOL_VERSION)
if dxl_comm_result != COMM_SUCCESS:
print(dynamixel.getTxRxResult(PROTOCOL_VERSION, dxl_comm_result))