drivers/servo: fixed very stupid coding error