This may not help you exactly but consider: Return calibrated pose - #9 by abiard
Every robot has calibration data which determines its real forward kinematics.
If you use only the generic robot model your inverse kinematics will always be off vs what the controller says.
1 Like