The code is written for DC motor PID control.
The goal is to make a mobile robot go perfect straight, the controller is in def go_straight(self):.
8/22/2016, new version code. Now the robot will do obstacle avoidance, and when it go forward, it will use PID to go straight.