On a slightly different note, I found
this LIDAR class in your code, but it doesn't appear that you use it anywhere else.
What did you plan on using the LIDAR for and why did you end up not using it (or am I just too blind to find it

)? Or was this just something you looked into during build season?