Change TWI address mask

seems to fix some issues when addresses are directed at the phasor and
that bit is not masked out
put system clock initialization in a function
neaten up main.c
Merge branch 'comm-rewrite' of github.com:topnotcher/gforce into comm-rewrite