Get Target TCP Speed

SUMMARY

Get Target TCP Speed returns the controller-commanded TCP twist [vx, vy, vz, ωx, ωy, ωz] - linear in m/s, angular in deg/s, expressed in the robot base frame.

Reads from the manipulator state - live controller setpoint when connected, zero-filled offline.

UNITS

Returns target TCP twist [vx, vy, vz, ωx, ωy, ωz] - linear in m/s, angular in deg/s.

The Skill

speed = robot.get_target_tcp_speed()

The Code

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

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

Usage:
    python get_target_tcp_speed.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 speed."""

    #===================== 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_speed [m/s, deg/s]: {robot.get_target_tcp_speed()}")
    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 speed 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_speed.py

Isaac Sim

python get_target_tcp_speed.py --prim_path /World/ur10e

Real

python get_target_tcp_speed.py --ip 192.168.1.100

For all options:

python get_target_tcp_speed.py --help

Parameter Configuration

This skill takes no input parameters.

Returns

Type	Description
list[float]	Controller-commanded TCP twist [vx, vy, vz, ωx, ωy, ωz]. Linear in m/s, angular in deg/s, expressed in the robot base frame. Zero-filled offline.

Where to Use the Skill

• Velocity tracking error - Compare against measured TCP twist from Get TCP Speed.
• Trajectory analysis - Monitor the commanded velocity profile during motion.

When Not to Use the Skill

• You need the measured TCP velocity - use Get TCP Speed instead.