Fixes to vision tracking system and tweaking of PID controller.