Add base version of vision code from https://github.com/JJulio/AHRobot
Add version of vision code that compiles with g++