Vision complete.  Added highly proportional P feedback loop