Hallo,

schau Dir doch mal dieses: https://www.roboternetz.de/community...+servo+library Projekt an.
Es sollte sich sicherlich leicht auf die M256 portieren lassen.