Rigid3d Tutorial |best| May 2026

Vector3d p_a(0.0, 1.0, 0.0); Vector3d p_b = T_ab * p_a; std::cout << "p_b: " << p_b.transpose() << std::endl; // Expected: after 90° Z rot: (0,1,0) -> (-1,0,0) then + translation (1,0,0) -> (0,0,0)

Rigid3D typically stores these as a unit quaternion (for rotation) and a 3-vector (for translation). For this tutorial, we'll use the Sophus::SE3d (C++) or scipy.spatial.transform.Rotation (Python). If you're working with ROS, tf2::Transform is analogous. C++ (Eigen + Sophus) #include <sophus/se3.hpp> #include <Eigen/Core> #include <iostream> using Sophus::SE3d; using Eigen::Vector3d; using Eigen::Quaterniond; Python (NumPy + SciPy or transforms3d) import numpy as np from scipy.spatial.transform import Rotation as R # Or use `from transforms3d.quaternions import quat2mat` 3. Creating a Rigid3D Object Let’s create a transformation that represents: rotate 90° about Z-axis, then translate by (1, 0, 0). rigid3d tutorial

[ p_B = R_AB \cdot p_A + t_AB ]

T_ac = T_ab @ T_bc Order matters. The rightmost transform is applied first to the point. 6. Inversion The inverse of a rigid transform ( T_ab ) is ( T_ba ). It rotates by ( R^T ) and translates by ( -R^T t ). Vector3d p_a(0