generalize raycast service to enable raycasts from other reference frames than robot.
encapsulate path in its own message, to be easily passable to goto controller