@@ -964,14 +964,16 @@ DxlError Dynamixel::ProcessReadCommunication(
964
964
if (is_sync) {
965
965
dxl_comm_result = group_sync_read->txPacket ();
966
966
if (dxl_comm_result != COMM_SUCCESS) {
967
- fprintf (stderr, " SyncRead Tx Fail [Dxl Size : %d] [Error code : %d]\n " ,
967
+ fprintf (
968
+ stderr, " SyncRead Tx Fail [Dxl Size : %d] [Error code : %d]\n " ,
968
969
read_data_list_.size (), dxl_comm_result);
969
970
return DxlError::SYNC_READ_FAIL;
970
971
}
971
972
} else {
972
973
dxl_comm_result = group_bulk_read->txPacket ();
973
974
if (dxl_comm_result != COMM_SUCCESS) {
974
- fprintf (stderr, " BulkRead Tx Fail [Dxl Size : %d] [Error code : %d]\n " ,
975
+ fprintf (
976
+ stderr, " BulkRead Tx Fail [Dxl Size : %d] [Error code : %d]\n " ,
975
977
read_data_list_.size (), dxl_comm_result);
976
978
return DxlError::BULK_READ_FAIL;
977
979
}
@@ -986,14 +988,16 @@ DxlError Dynamixel::ProcessReadCommunication(
986
988
if (is_sync) {
987
989
dxl_comm_result = group_sync_read->rxPacket ();
988
990
if (dxl_comm_result != COMM_SUCCESS) {
989
- fprintf (stderr, " SyncRead Rx Fail [Dxl Size : %d] [Error code : %d]\n " ,
991
+ fprintf (
992
+ stderr, " SyncRead Rx Fail [Dxl Size : %d] [Error code : %d]\n " ,
990
993
read_data_list_.size (), dxl_comm_result);
991
994
return DxlError::SYNC_READ_FAIL;
992
995
}
993
996
} else {
994
997
dxl_comm_result = group_bulk_read->rxPacket ();
995
998
if (dxl_comm_result != COMM_SUCCESS) {
996
- fprintf (stderr, " BulkRead Rx Fail [Dxl Size : %d] [Error code : %d]\n " ,
999
+ fprintf (
1000
+ stderr, " BulkRead Rx Fail [Dxl Size : %d] [Error code : %d]\n " ,
997
1001
read_data_list_.size (), dxl_comm_result);
998
1002
return DxlError::BULK_READ_FAIL;
999
1003
}
@@ -1019,13 +1023,16 @@ DxlError Dynamixel::ProcessReadData(
1019
1023
uint32_t dxl_getdata = get_data_func (id, current_addr, size);
1020
1024
1021
1025
if (item_names[item_index] == " Present Position" ) {
1022
- *data_ptrs[item_index] = dxl_info_.ConvertValueToRadian (id,
1026
+ *data_ptrs[item_index] = dxl_info_.ConvertValueToRadian (
1027
+ id,
1023
1028
static_cast <int32_t >(dxl_getdata));
1024
1029
} else if (item_names[item_index] == " Present Velocity" ) {
1025
- *data_ptrs[item_index] = dxl_info_.ConvertValueRPMToVelocityRPS (id,
1030
+ *data_ptrs[item_index] = dxl_info_.ConvertValueRPMToVelocityRPS (
1031
+ id,
1026
1032
static_cast <int32_t >(dxl_getdata));
1027
1033
} else if (item_names[item_index] == " Present Current" ) {
1028
- *data_ptrs[item_index] = dxl_info_.ConvertCurrentToEffort (id,
1034
+ *data_ptrs[item_index] = dxl_info_.ConvertCurrentToEffort (
1035
+ id,
1029
1036
static_cast <int16_t >(dxl_getdata));
1030
1037
} else {
1031
1038
*data_ptrs[item_index] = static_cast <double >(dxl_getdata);
0 commit comments