Fixed ControlLoop, added second wheel