Waypoint recorder now subscribes to "robot_pose" topic rather then to "amcl" pose.
This causes the waypoint to be saved at the moment and place the user wants.
Thus, the waypoints can be specified more precisely.