Working on servo/PWM/timer libraries