좌표주면 로봇 엔드 이펙터가 좌표 따라가는 거 만들려고하는데 역기구학 쓰는거 맞지?

이거 역기구학 어떻게 구하냐? 본인 기구학 잼병이라 잘모르겠음

viewimage.php?id=3db5c935ecd139aa7dbcdfb018d221&no=24b0d769e1d32ca73dec84fa11d0283195504478ca9b7677dc322d30ca359b45bc703aaf7d0996c40a589f0da1c68cd541234136968deadaf7045abbda8778da7b855ffee0c9c680


viewimage.php?id=3db5c935ecd139aa7dbcdfb018d221&no=24b0d769e1d32ca73dec84fa11d0283195504478ca9b7677dc322d30ca359b45bc703aaf7d0996c40a589f0da1c68cd541234136968deadaf7045abbdbdb78daf8c1a1dd5b71cc84



위에 처럼 동차변환행렬은 다 구했는데 역기구학은 진짜 모르겠네 ㅅㅂ 좌표 넣으면 각도 th1 th2 th3 나오게 하고 싶은데.....