Added text output to image IDing the detected robots.
Fixed errorneous heading detection and updated default vision params.