Du sendest einfach drei Bytes hintereinander, den Startcode, die Servonummer, und die gewünschte Position. Du musst also nur eine Funktion haben, mit der du Daten senden kannst.