Update Functions.c

Commented the code and changes some stuff around (like functions now work by degree and not rotation)