Finished wall follow code. Works like the python version.
Implemented steering trimming in the controller class, works. Also added a directory for testing code.
Implemented a way to handle keyboard interrupts and kill the robot
Did I fuck it up?
Testing git pull
Added initilization list for trim values
added a space to CMake