Use hysteresis in motor controller. Use odometry for turning. Recalibrated motor controller. Add motor constant calibrator node.

Had to disable i term. Hysteresis breaks that. Should be further investigated.
Turning is pretty good at this point +- 3 degrees.
Wall follower has a left drift at this point. Should be further investigated.