diff --git a/bioloid_controller_cm510/include/bioloid_controller_cm510_impl.h b/bioloid_controller_cm510/include/bioloid_controller_cm510_impl.h index f23b2011649345879883815e44f943ed4ca405ac..289325646070ed519f9899e0e5131e5de6f17946 100644 --- a/bioloid_controller_cm510/include/bioloid_controller_cm510_impl.h +++ b/bioloid_controller_cm510/include/bioloid_controller_cm510_impl.h @@ -326,6 +326,8 @@ namespace bioloid_controller_cm510 manager_init(num_servos); if(exp_board_id!=-1) exp_board_init(exp_board_id); + action_set_page(31); + action_start_page(); first=false; } @@ -521,7 +523,8 @@ namespace bioloid_controller_cm510 exp_gpio_values[17]=threshold; else if(frame_name==this->exp_gpio18_frame) exp_gpio_values[18]=threshold; - } + } + std::cout << (int)exp_gpio_values[0] << "," << (int)exp_gpio_values[1] << "," << (int)exp_gpio_values[2] << "," << (int)exp_gpio_values[3] << "," << (int)exp_gpio_values[4] << "," << (int)exp_gpio_values[5] << std::endl; } template <class HardwareInterface> diff --git a/bioloid_description/urdf/bioloid.gazebo b/bioloid_description/urdf/bioloid.gazebo index f3354d45db563b44d6c7e975e5727091398c18bb..56ae3d5295784dc297d8764cb3cf947bbd9742a5 100644 --- a/bioloid_description/urdf/bioloid.gazebo +++ b/bioloid_description/urdf/bioloid.gazebo @@ -243,8 +243,8 @@ <dampingFactor>0.2</dampingFactor> <maxVel>0.0</maxVel> <minDepth>0.0</minDepth> - <mu1>1.0</mu1> - <mu2>1.0</mu2> + <mu1>0.2</mu1> + <mu2>0.2</mu2> <kp>0.0</kp> <kd>0.0</kd> </gazebo> @@ -321,8 +321,8 @@ <dampingFactor>0.2</dampingFactor> <maxVel>0.0</maxVel> <minDepth>0.0</minDepth> - <mu1>1.0</mu1> - <mu2>1.0</mu2> + <mu1>0.2</mu1> + <mu2>0.2</mu2> <kp>0.0</kp> <kd>0.0</kd> </gazebo> diff --git a/bioloid_gazebo/launch/bioloid_gazebo.launch b/bioloid_gazebo/launch/bioloid_gazebo.launch index 0481bd68de9b0a03f315d214bc867329c62c05fa..d88d18b305ab5c1e022087aa032b60633631d3fd 100644 --- a/bioloid_gazebo/launch/bioloid_gazebo.launch +++ b/bioloid_gazebo/launch/bioloid_gazebo.launch @@ -14,7 +14,7 @@ </include> <!-- Spawn a robot into Gazebo --> - <node name="spawn_urdf" pkg="gazebo_ros" type="spawn_model" args="-param robot_description -urdf -model bioloid -x 0 -y 0 -z 0.32 -R 1.5707 -P 0 -Y 0"/> + <node name="spawn_urdf" pkg="gazebo_ros" type="spawn_model" args="-param robot_description -urdf -model bioloid -x 0 -y 0 -z 0.35 -R 1.5707 -P 0 -Y 0"/> </launch>