Functional Code + analogWr function

The code actually functions now., also added an analogWr function that
wraps analogWrite to extend PWM to pin 4 but use the same function to
write to all three, abstracting the complexity out a bit.