Wenn du nicht unbedingt deine Servoansteuerung selbst schreiben willst (Lerneffekt ), dann gibt es hier im Forum auch eine kleine Library für bis zu acht Servos an der M32.