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.