motorcontroller: implemented wall following code

Implemented the variables, defines, and functions to use the wall
following code alongside odometry. Also cleaned up a lot of unused code
and optimized a few functions like the turning left/right and the
interrupts to not do redundant/extraneous calculations.