Clean, commented, object-oriented PWM servo code

Fully commented code