Moved the ''findPrefixPath'' function from BeliefstateROS to Beliefstate

The function is not ROS specific, so it goes into the superclass where it might be useful to other functionality as well.