Made helper function for ir distances in range, wall presents and front obstacle present.
Made defines of constants. Made wall following switch side now and made the turning more general depending on which wall side the robot is following