Don't record chest camera in rosbag and add ability to play back just one waypoint

Pretty straightforward, this doesn't run on the robot unless the chest topics are removed