Tim's implementation of the P2OS driver for ROS and Pioneers