PWM init added & servo control response. This closes #3