Update FirstTest.py

Added turning function when bot gets too close to a wall