Changed to work on MBED
PWM1 working