tangger/lerobot
1
0
Fork 1
Code Issues Pull Requests Actions 1 Packages Projects Releases Wiki Activity

[pre-commit.ci] auto fixes from pre-commit.com hooks

Browse Source 
for more information, see https://pre-commit.ci
This commit is contained in:
pre-commit-ci[bot]
2025-05-12 16:05:45 +00:00
committed by AdilZouitine
parent 335c92c961
commit 42b0efdd99
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
lerobot/scripts/server/kinematics.py
View File

@@ -53,12 +53,12 @@ def pose_difference_se3(pose1, pose2):
Calculates the SE(3) difference between two 4x4 homogeneous transformation matrices. Calculates the SE(3) difference between two 4x4 homogeneous transformation matrices.
SE(3) (Special Euclidean Group) represents rigid body transformations in 3D space, combining rotation (SO(3)) and translation. SE(3) (Special Euclidean Group) represents rigid body transformations in 3D space, combining rotation (SO(3)) and translation.
Each 4x4 matrix has the following structure, a 3x3 rotation matrix in the top-left and a 3x1 translation vector in the top-right: Each 4x4 matrix has the following structure, a 3x3 rotation matrix in the top-left and a 3x1 translation vector in the top-right:
[R11 R12 R13 tx] [R11 R12 R13 tx]
[R21 R22 R23 ty] [R21 R22 R23 ty]
[R31 R32 R33 tz] [R31 R32 R33 tz]
[ 0 0 0 1] [ 0 0 0 1]
where Rij is the 3x3 rotation matrix and [tx,ty,tz] is the translation vector. where Rij is the 3x3 rotation matrix and [tx,ty,tz] is the translation vector.
pose1 - pose2 pose1 - pose2