changed timestamp to be ROS timestamp.
added ros pose output