Changing Back Math to Bitwise

Functions.

The problem here is that, if the bit is already set, this will disable
the bit and enable other bits...
Merge pull request #3 from hydroArgentum/MSP430

Changing Back Math to Bitwise Functions