Python Library pytransform3d Adds Transformation Graphs, Uncertainty Handling, and 3D Visualization for Robotics

Every robot arm reaching for an object, every drone stabilizing in flight, and every quadruped scrambling over rocky terrain depends on the same mathematical machinery: rigid transformations in three dimensions. These compact descriptions of position and orientation are the backbone of robotics, computer vision, graphics, and physics simulation. Yet practitioners who work with them daily face a surprising number of traps, from competing conventions for quaternions and Euler angles to singularities, ambiguities, and the sheer bookkeeping burden of tracking hundreds of coordinate frames in a complex system. A newly published article in Frontiers in Robotics and AI presents the latest features of pytransform3d, an open-source Python library designed to make these pitfalls manageable, and demonstrates them on problems ranging from imitation learning to state estimation on a real quadruped robot.

The library, developed at the German Research Center for Artificial Intelligence (DFKI) in Bremen together with the Robotics Research Group at the University of Bremen, takes an unusual design stance for modern software: it hides nothing. There is no operator overloading, no wrapper classes around rotations or transformations, and no layers of abstraction beyond plain NumPy arrays. According to the authors, Alexander Fabisch of DFKI and Mihaela Popescu of the University of Bremen, this transparency is deliberate. The library targets debugging, prototype implementation, log analysis, and data processing for data science and machine learning in robotics, domains where being able to read and review the code matters as much as raw speed.

At its mathematical core, pytransform3d handles elements of two fundamental groups. The special orthogonal group SO(3) describes rotations in three dimensions, while the special Euclidean group SE(3) describes full rigid transformations, combining rotation with translation. The library implements an unusually broad set of representations for both: rotation matrices, unit quaternions, Euler angles, rotation vectors, logarithms of rotations, modified Rodrigues parameters, transformation matrices, unit dual quaternions, position-quaternion pairs, exponential coordinates, and logarithms of transformations. Each representation comes with a consistent family of functions for input validation, normalization, random sampling, and conversion between formats. The library also provides explicit checks for the classic failure modes of rotation mathematics, including gimbal lock near singularities, angle periodicity, and the double cover problem, in which two different quaternions represent the same physical rotation.

Quaternion conventions alone are a notorious source of silent bugs. The library documents its choices explicitly: it uses the Hamilton convention for the quaternion product rather than the Shuster convention, places the scalar component first, and provides tools to detect when antipodal quaternions must be reconciled during interpolation or equality checks. The authors argue that this explicit terminology makes code readable and reviewable, a property they consider essential for research software where correctness is difficult to verify by eye.

Among the new features, the transformation graph manager stands out. Inspired by the tf system of the Robot Operating System (ROS), the TransformManager class organizes coordinate frames as vertices in a directed graph, with transformations as edges. When a user requests a transformation between two frames that are not directly connected, the manager computes the shortest path through the undirected version of the graph, concatenates the transformations along that path, and inverts edges where necessary. Two subclasses extend this idea: UrdfTransformManager loads robot descriptions from the unified robot description format (URDF) and computes forward kinematics by combining joint configurations with the graph, while the new TemporalTransformManager handles time-varying transformations, allowing the graph to represent poses that change over time.

The article demonstrates the graph machinery with an automatic embodiment mapping problem: transferring human hand motion, recorded by a marker-based motion capture system, onto a robotic hand. Using a multichain inverse kinematics approach, the researchers matched a MANO hand model to the measured human configuration and then found a configuration of a robotic hand with 4 or 24 degrees of freedom that closely resembles it. A Numba-accelerated variant of the URDF manager, called FastUrdfTransformManager, allowed the solver to run at mean frequencies of 128 to 181 hertz for the complex hand and 228 to 294 hertz for the simpler one on a standard desktop computer, fast enough for prototyping real-time applications even though much of the code remains in pure Python.

Uncertainty is the second major addition. In robotics, almost no transformation is known exactly, and pytransform3d.uncertainty models uncertain transformations as Gaussian distributions whose means are transformation matrices and whose covariances live in the space of exponential coordinates, the six-dimensional space of screw motions. This choice captures the interdependence between rotational and translational uncertainty. The module distinguishes carefully between uncertainty defined in a global reference frame, applied by left multiplication, and uncertainty defined in the local body frame, applied by right multiplication. Functions implement composition, inversion, and fusion of uncertain transformations, and the library can visualize the equiprobable six-dimensional hyperellipsoid of a pose distribution projected into three dimensions.

Two examples show why this matters. In a state estimation scenario adapted from the literature, a robot moving at constant velocity with noisy angular velocity accumulates error into the so-called banana distribution, which looks distinctly non-Gaussian in Cartesian space but is Gaussian in exponential coordinates. The library reproduces this behavior with a single composition function and visualizes the banana-shaped uncertainty directly. In a second example, the authors implement the probabilistic product of exponentials for a robotic arm, propagating covariance through each joint displacement and transferring the resulting uncertainty from end-effector frame to base frame with an adjoint transformation, again in a few lines of code.

The third showcase is batch processing and plotting, demonstrated on real field data. The authors analyzed publicly available recordings of a Unitree Go2 quadruped walking 25 meters over rocky terrain on Vulcano Island, where an invariant extended Kalman filter fused 1,000-hertz inertial and joint encoder data with centimeter-level satellite positioning. Because the filter’s covariance lives in the tangent space of the matrix Lie group SE_2(3), the authors extracted the pose covariance, transformed it to the world frame with an adjoint, and plotted the projected uncertainty hyperellipsoids alongside the robot model reconstructed from joint encoders. The figures show uncertainty and position drift growing over time, exactly as expected when odometry accumulates error without external corrections.

Benchmarks underline the practical appeal. In a trajectory alignment task, pytransform3d solved the problem in 28 lines of code compared with 34 for the C++-backed manif library, and it was the fastest of the four libraries tested, averaging 3.1 milliseconds per run on a single CPU core, versus 7.1 milliseconds for SciPy, 7.4 milliseconds for manif, and 107.0 milliseconds for spatialmath, whose lack of vectorized conversion forces a Python loop over every pose. The library has been downloaded 2.4 million times from PyPI, achieves 100 percent test coverage of its core features, and is released under the BSD 3-Clause License. The authors acknowledge limitations: for hard real-time systems, C++ implementations such as ROS tf remain preferable, and the library covers kinematics only, not dynamics. Looking forward, a JAX-based sibling project called jaxtransform3d, currently experimental, promises GPU acceleration and automatic differentiation, while some conversions have already been adopted into SciPy’s new RigidTransform class, a sign that the library’s ideas are spreading into the wider scientific Python ecosystem.

Subject of Research: New features of the pytransform3d Python library for 3D rigid transformations in robotics, including transformation graphs, uncertainty propagation, and visualization

Article Title: New features of pytransform3d for robotics research: transformation graphs, uncertainty, and 3D visualization in Python

Article References: Fabisch, A., & Popescu, M. (2026). New features of pytransform3d for robotics research: transformation graphs, uncertainty, and 3D visualization in Python. Frontiers in Robotics and AI, 13, Article 1860457. https://doi.org/10.3389/frobt.2026.1860457

Image Credits: AI Generated

DOI: 10.3389/frobt.2026.1860457

Keywords: pytransform3d, robotics, rigid transformations, SO(3), SE(3), quaternions, transformation graphs, uncertainty propagation, state estimation, 3D visualization, Python, open-source software