Got it working with PWMServo
Arduino works
Updated to work with new Arduino Code