https://mbed.org/users/simon/code/Servo/#36b69a7ced07