VisualServoing pseudo Code

PD controller given blockHeading output left&right motor "voltage"