mirror of
https://github.com/orbbec/OrbbecSDK_ROS2.git
synced 2026-10-04 20:17:47 +08:00
Resolve Bolt's coordinate abnormality issue.
This commit is contained in:
@@ -1259,6 +1259,7 @@ void OBCameraNode::calcAndPublishStaticTransform() {
|
|||||||
"transform x " << ex.trans[0] << " y " << ex.trans[1] << " z " << trans[2]);
|
"transform x " << ex.trans[0] << " y " << ex.trans[1] << " z " << trans[2]);
|
||||||
Q = rotationMatrixToQuaternion(ex.rot);
|
Q = rotationMatrixToQuaternion(ex.rot);
|
||||||
Q = quaternion_optical * Q * quaternion_optical.inverse();
|
Q = quaternion_optical * Q * quaternion_optical.inverse();
|
||||||
|
Q = Q.inverse();
|
||||||
trans[0] = ex.trans[0];
|
trans[0] = ex.trans[0];
|
||||||
trans[1] = ex.trans[1];
|
trans[1] = ex.trans[1];
|
||||||
trans[2] = ex.trans[2];
|
trans[2] = ex.trans[2];
|
||||||
|
|||||||
Reference in New Issue
Block a user