Merki, jeśli masz możliwość, to narysuj to normalnie na kartce z zaznaczonymi osiami i zrób zdjęcie/zeskanuj 🙂
Ponadto, nie wstawiaj wartości typu 90/0, tylko podaj funkcję trygonometryczną. Jeśli chcesz żeby Ci pomóc, zrób to co masz robić porządnie, rozpisz wszystkie macierze przekształceń (lub chociaż podaj w formie: A0->1 = Rot(Z,q1) * Tr(X,l1) * Rot(X,pi/2)).
Trochę też nie rozumiem długości d3, bo z tego co opisałeś wygląda na to, że jest to odległość między członami obrotowymi, tak? Mówię, prościej będzie wszystko zrozumieć jak narysujesz to odręcznie.
Na pewno uda się dojść do rozwiązania 🙂