Added vision distance
turn() and drive() methods working
Tested drive in square