Hi,
der erste Schritt ist die Bewegungsgleichungen aufzustellen, d.h. wahrscheinlich Drallsatz für alle Gelenke/Motoren. Wenn du das hast, schau dir in einem Simulink tutorial an wie man Dgl'en simuliert und schon haste es Bild  .

Bei Fragen, einfach melden

Gruss
cyberbot