HMM in python for Octomap_node in ROS as a service