Fix for math overflow bug in SoftPWMServo library (issue #392)