Final Code

LIDAR_FINAL is the code used to generate the final plots. ServoPlay was
changed to test servo positions. LIDAR_ino was created and used in place
of LIDAR.