First full working version.

Topics are played back but this is all at the mercy of rospy.sleep