Bica ako ti se neda raditi DH, uzmes sa wikipedie matrice rotacije po X Y Z, nadjes vektore pomaka, stavis to u onu 4×4 H matricu i izmnozis ih sve sa numpy, može se dobiti broj identičan (eventualno neki rounding error na petoj sestoj decimali) kao u gazebu.
Za naći roll pitch yaw googlaj “rotation matrix to roll pitch yaw”, to su samo neke analiticke jednadzbe.
Udaljenosti zglobova također moraš očitat direkt iz gazeba, one dimenzije su za IRL robota.