Commented out serial.begin and added new program with ROS functionality. It currently has some weird bugs with rosserial, but definitely works.