gps-sim: send position 5 times a second
gps-sim: send full pos and ori as Pose