This is the code that was written to be tested on the board bot before going onto the actual robot