Ask Your Question

Connect MoveIt! with real robot (hardware)

asked 2018-04-17 14:37:14 -0500

znbrito gravatar image


I am on Ubuntu 16.04 LTS and ROS Kinetic. I am trying to control a Robotis Manipulator-H with MoveIt! and I have been able to do it in Gazebo (using this links: and ), so now I am trying to do that in the real robot. I have searched a lot on how to do this but I can't really find anything... I have tried the package "dynamixel_controllers" and the tutorial in this link:

To connect the manipulator with MoveIt! but I wasn't able to do it since this tutorials uses the package "dynamixel_controllers" and it only works with Dynamixel motors and not Dynamixel PRO motors (which are the ones used bu the Manipulator-H). I also found out that I need an action server and a client server (or something like that) but since I am a newbie, I don't know how this properly works... can you guys give me any advices on how to connect the manipulator? I think this topic is a lot under documented...

Other packages that I tried but with no success: "dynamixel_workcbench" and "open_manipulator".

Thanks!, José Brito

edit retag flag offensive close merge delete


Hi Jose, Are you able to solve this issue to connect MoveIt to real Manipulator-H arm? Now, I have same problem here, but don't know how to solve. I would like to know your current situation. Thanks.

idrobot gravatar image idrobot  ( 2018-06-14 06:56:30 -0500 )edit

Hi Jose, did u solved the problem. I'm also facing same problem but i'm using hubby HS422 servo motor, can i use dynamixel_controllers pkg for move it interface? I tried that but it is not working. Please help me..

Ravi_Kanth gravatar image Ravi_Kanth  ( 2018-06-18 04:44:05 -0500 )edit

Hello @idrobot and @Ravi_Kanth, yes I kinda solved the problem by adapting myself the packages from the implemented Robotis Open Manipulator. I did this by commenting the parts of the code where grips where mentioned and by adding the joints of the Robotis Manipulator-H to the following packages:

znbrito gravatar image znbrito  ( 2018-06-18 04:55:11 -0500 )edit

All in kinetic devel: - open_manipulator_description - open_manipulator_dynamixel_ctrl - open_manipulator_moveit - open_manipulator_msgs - open_manipulator_position_ctrl

Keep in mind that there are functions for Gazebo with parts that I didn't know hot to erase or change

znbrito gravatar image znbrito  ( 2018-06-18 04:55:53 -0500 )edit

I simply ignored them since I didn't need to used them! :)

znbrito gravatar image znbrito  ( 2018-06-18 04:57:24 -0500 )edit

To use, simply connect the manipulator to the PC via USB and type the following: - FIRST TERMINAL: $ sudo chmod a+rw /dev/ttyUSB0 $ roslaunch open_manipulator_dynamixel_ctrl dynamixel_controller.launch - SECOND TERMINAL: $ roslaunch open_manipulator_moveit open_manipulator_demo.launch

znbrito gravatar image znbrito  ( 2018-06-18 04:58:37 -0500 )edit

I had a problem still. Open manipulator has 4 joints, while the Manipulator-H has 6. The 5th and 6th joints were being read with a small offset error and I don't know why... luckily, I had another package (confidential) previously developed to read the joint values, so I used it and I now I am good!

znbrito gravatar image znbrito  ( 2018-06-18 05:01:11 -0500 )edit

Still I don't know how you would solve this problem, if you'd ever face it... one more thing, with this program you can only "plan and execute" and not "plan" and then "execute". This is because of the way the packages is developed, please see the link in me following comment

znbrito gravatar image znbrito  ( 2018-06-18 05:06:08 -0500 )edit

1 Answer

Sort by » oldest newest most voted

answered 2018-04-17 20:09:14 -0500

Darby Lim gravatar image

Hi :) Nice to see you again.

ROBOTIS has provided github repository for Manipulator-H ( ) I recommend to use this package to control it in Gazebo. Furthermore, dynamixel_controllers are not supported by ROBOTIS. This package doesn't support to Dynamixel PRO as i know.

In order to control Dynamixel PRO, you should use one of ROBOTIS official packages such as DynamiselSDK ( ), Dynamixel-Workbench ( ) or ROBOTIS-Framework ( ). Most of all, ROBOTIS-Framework is used to control Thormang3 which is assembled by Dynamixel PRO. So this package would be help you. If you have any question or issue, please visit there issue page.

Your main goal is to connect the manipulator to MoveIt!. Below steps would be help you.

  1. Make MoveIt! Package to use setup assistant ( )
  2. Control your Dynamixel by ROS package ( )
  3. Check which topic is to send joint position or planned path (For example "/move_group/display_planned_path")
  4. Connect path topic to joint control topic ( )

Good luck!

edit flag offensive delete link more


Hi, Darby, thanks for your response. Step one 1 I already did when controlling the manipulator in Gazebo. In step 2, I don't understand hat do you mean by controlling my Dynamixel by ROS package. Is this the package that should allow me to subscribe and publish joint states?

znbrito gravatar image znbrito  ( 2018-04-18 03:26:10 -0500 )edit

In step 3 and 4, the link that you sent me has a lot of gripper configurations and is not properly set to my manipulator... how can I properly configure it? And what launch files should I use? Your answer was a bit vague in that sense...

znbrito gravatar image znbrito  ( 2018-04-18 03:34:35 -0500 )edit

To make my manipulator work with Gazebo, I had to configure a lot of files and you didn't point my almost no one

znbrito gravatar image znbrito  ( 2018-04-18 03:35:04 -0500 )edit

Yes, you can control Dynamixel by topic to use that packages. When you pressed plan and execute button in Rviz, you can get a planned path through "/move_group/display_planned_path" topic. Subscribe it and publish to another topic related to control Dynamixel.

Darby Lim gravatar image Darby Lim  ( 2018-04-18 19:39:11 -0500 )edit

Hmm could you send me an example please? I am still very confused... In rviz gui for moveit the bluetooth sphere doesn't appear in the end effector, and that's why I know that something os wrong

znbrito gravatar image znbrito  ( 2018-04-18 19:46:35 -0500 )edit

Your Answer

Please start posting anonymously - your entry will be published after you log in or create a new account.

Add Answer

Question Tools



Asked: 2018-04-17 14:37:14 -0500

Seen: 1,573 times

Last updated: Apr 17 '18