stmhal: Add functionality to Servo object.

Can now calibrate, set pulse width, angle and speed.