Worked on block avoidance

Made the distance it drives ahead a function of the threshold. Also added boolean checks for walls.