You will find in the link below the display coordinates model.
This model will display its dummy’s position, quaternion, orientation, and pose relative to its parent. This model will allow you to quickly integrate the positions of your robot into the script. Just copy and paste the desired position in your code:
https://drive.google.com/file/d/132a-ErdVL0SRuPMYmJwbvLWTi63mLw-4/view?usp=sharing