Ported OpenBottomServo to cpp