Schau mal an wie das im Asuro gemacht wird: http://www.henkessoft.de/Roboter/ASURO.htm (am ende diese Seite)