Ich kenne kein Programm. Vielleicht findest du im Internet eines, schau auch auf Robotikhardware.de, vielleicht gibt es ein Beispielprogramm.

MfG Hannes