init
Tidy variables

Change Colors to ease visual debugging.
add type 'double' for trig maths functions.
Improve descriptions for variables.
Fix some tiny typo in serial blocks causing command
'Serial.begin(9600);' to be added multiple time.
my tiny typo
Merge pull request #84 from TonyCallear/Improve-variables

Improve variables