Commit of 1st servo changes

Addition of two functions for changing the angle of the wheels,
functions are commented in TFC_Servo.c
Addition of lookup table and functions using lookup table

Not positive that lookup table is stored in flash at the moment... but
functionality of functions is very similar to previous ones so we may as
well get used to using them.
Merge pull request #1 from jakeconnor/Servo

Servo merge