Major Cleanups
Ref -> Cleaned up, more TODO later please check notations.
GPS -> Cleaned and up and running.
BT  -> Cleaned and up and running.

Program can compile and runs without any crashes.
Merge remote-tracking branch 'origin/master'