added start of avoidance algorithm

Uses mapping function to adjust the values of the infrared sensors to a
specified range. The resulting values will be added and subtracted from
the value sent to the steering servo.