Write SW Module to Convert POSE to Location_t
Using 4K03 Robotics knowledge make a function that convert pose info (a 7 field vector of joint positions) into a location_t (x, y, z, theta1, theta2, theta3) of the end-effector.
There should be a library to do this.
Do in C or C++.