Get Target TCP Pose

SUMMARY

Get Target TCP Pose returns the controller-commanded TCP pose [x, y, z, rx, ry, rz] - position in meters, orientation as Euler XYZ in degrees, expressed in the robot base frame.

Reads from the manipulator state - live controller setpoint when connected, mirrors the cached tcp_pose offline.

UNITS

Returns target TCP pose [x, y, z, rx, ry, rz] - translation in meters, orientation in Euler XYZ degrees.

The Skill

pose = robot.get_target_tcp_pose()

The Code

"""
Logs the controller-commanded target TCP pose.

Supports Universal Robots (UR), Epson, virtual, and Isaac Sim.

Usage:
    python get_target_tcp_pose.py [--ip <ROBOT_IP>] [--prim_path <PRIM_PATH>]
"""

import argparse

from loguru import logger

from telekinesis.synapse.robots.manipulators import universal_robots


def main(ip: str | None, prim_path: str | None) -> None:
    """Log the controller-commanded target TCP pose."""

    #===================== Create Robot ==========================================
    robot = universal_robots.UniversalRobotsUR10E(name='UR10e')

    try:
        #===================== Connect Robot ==========================================
        if ip:
            robot.connect(ip=ip)
        elif prim_path:
            robot.connect(simulation_prim_path=prim_path)
            robot.set_joint_positions(robot.default_joint_configuration)

        # ==================== Run Skill ============================================
        logger.success(f"target_tcp_pose [m, deg]: {robot.get_target_tcp_pose()}")
    except (ConnectionError, OSError) as e:
        logger.error(f"Error occurred: {e}")
    finally:
        robot.disconnect()
        robot.shutdown()


if __name__ == "__main__":
    parser = argparse.ArgumentParser(description="Read target TCP pose Synapse example")
    parser.add_argument("--ip", type=str, default=None,
                         help="UR robot IP address for real hardware, e.g. 192.168.1.100")
    parser.add_argument("--prim_path", type=str, default=None,
                         help='Isaac Sim articulation prim path, e.g. "/World/ur10e"')
    args = parser.parse_args()

    main(ip=args.ip, prim_path=args.prim_path)

Running the Example

Virtual

python get_target_tcp_pose.py

Isaac Sim

python get_target_tcp_pose.py --prim_path /World/ur10e

Real

python get_target_tcp_pose.py --ip 192.168.1.100

For all options:

python get_target_tcp_pose.py --help

Parameter Configuration

This skill takes no input parameters.

Returns

Type	Description
list[float]	Controller-commanded TCP pose [x, y, z, rx, ry, rz] in the robot base frame. Position in meters, orientation as Euler XYZ in degrees. Offline: same as the cached tcp_pose.

Where to Use the Skill

• Cartesian tracking error - Compare against measured pose from Get Cartesian Pose.
• Motion monitoring - Observe the commanded TCP trajectory in real time.

When Not to Use the Skill

• You need the measured TCP pose - use Get Cartesian Pose instead.