stmhal: Add servo driver.