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 #71 from ROBOTIS-GIT/feature_gazebo_bug_fixed

Browse Source 
- gazebo bug fixed (when ctrl_module_name_ == "none")
This commit is contained in:
zerom
2018-12-20 16:58:08 +09:00
committed by GitHub
parent 7b7250c4e5 edde9d26cb
commit 9e37fc645c
1 changed files with 15 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

17
robotis_controller/src/robotis_controller/robotis_controller.cpp
View File

@ -1097,13 +1097,26 @@ void RobotisController::process()
}
else if (gazebo_mode_ == true)
{
std_msgs::Float64 joint_msg;
for (auto& dxl_it : robot_->dxls_)
{
std::string joint_name = dxl_it.first;
Dynamixel *dxl = dxl_it.second;
DynamixelState *dxl_state = dxl_it.second->dxl_state_;
if (dxl->ctrl_module_name_ == "none")
{
joint_msg.data = dxl_state->goal_position_;
gazebo_joint_position_pub_[joint_name].publish(joint_msg);
}
}
for (auto module_it = motion_modules_.begin(); module_it != motion_modules_.end(); module_it++)
{
if ((*module_it)->getModuleEnable() == false)
continue;
std_msgs::Float64 joint_msg;
for (auto& dxl_it : robot_->dxls_)
{
std::string joint_name = dxl_it.first;