Sieht so nach Denavit und Hartenberg Matrix aus und würde wohl auch passen für die Problemstellung. Wie die genaue Umsetzung im Skript der mathematischen Gesetzmässigkeit aussieht musst du wohl doch selber raus finden.