Make scan an object variable, add some helper functions, and complete the ROS code to tie everything together.