Add new PWM functionality 'pwm_write' and 'pwm_init'