BRSRI/bellande_humanoid_robot_intelligence_control_system_framework
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Merge pull request #78 from ROBOTIS-GIT/develop

Browse Source 
Added ability to check for bulkread success.
This commit is contained in:
Kayman
2019-06-05 16:28:42 +09:00
committed by GitHub
parent e8a4ee48bb 1b746fbf04
commit c4c00e13f1
1 changed files with 8 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

13
robotis_controller/src/robotis_controller/robotis_controller.cpp
View File

@@ -925,11 +925,14 @@ void RobotisController::process()
for (auto& it : port_to_bulk_read_)
{
robot_->ports_[it.first]->setPacketTimeout(0.0);
//it.second->rxPacket();
int result = it.second->rxPacket();
if(result != COMM_SUCCESS)
ROS_ERROR_STREAM("Bulk Read Fail : " << it.first);
if(DEBUG_PRINT)
{
int result = it.second->rxPacket();
if(result != COMM_SUCCESS)
ROS_ERROR_STREAM("Bulk Read Fail : " << it.first);
}
else
it.second->rxPacket();
}
// -> save to robot->dxls_[]->dxl_state_