first version of the bh_motion ROS package. TODO: Documentation