ROS/Hydro, MoveIt 0.5.8 compatiblity; Work in progress...