I'm certainly no expert with servos, but can't Darrel's SSPWM do this?