Implemente PID in the wall follower (u_theta only).