Wrote servo output functionality.