Skip to content

Commit 41333c8

Browse files
committed
implicit fixed joint fixed transform
1 parent 1930178 commit 41333c8

File tree

2 files changed

+139
-547
lines changed

2 files changed

+139
-547
lines changed

Runtime/Scripts/Document/ZOSimOccurrence.cs

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -1287,7 +1287,7 @@ protected void BuildURDFJoints(XElement robot, ZOSimOccurrence parent, Matrix4x4
12871287
} else { // children of the parent even without an explicit joint are "fixed" joints
12881288

12891289
jointX.SetAttributeValue("type", "fixed");
1290-
jointMatrix = this.transform.WorldTranslationRotationMatrix() * parent.transform.WorldTranslationRotationMatrix().inverse;
1290+
jointMatrix = parent.transform.WorldTranslationRotationMatrix().inverse * this.transform.WorldTranslationRotationMatrix();
12911291

12921292
Vector3 xyz = jointMatrix.Position().Unity2Ros();
12931293
Vector3 rpy = jointMatrix.rotation.Unity2RosRollPitchYaw();

0 commit comments

Comments
 (0)