NaturalPoint Help Center - OptiTrackNaturalPoint Help Center - OptiTrack
https://help.naturalpoint.com/kb/optitrack
Fri, 21 Jan 2022 18:09:12 +0000Fri, 21 Jan 2022 18:09:12 +00001800Transform World-Space Coordinates to Local Rigid Body Coordinates<p><span style="font-size:large;"><img src="https://cdn.deskpro.com/files/1292/247/246910NPNJDJWXRBSJNNZ0-optitracklogo_23_feb_11.JPG" alt="" width="200" height="100"></span></p>
<p><span style="font-size:large;">The API reports "world-space" values for markers and rigid body objects at each frame. It is often desirable to convert the coordinates of points reported by the API from the world-space (or global) coordinates into the local space of the rigid body. This is useful, for example, if you have a rigid body that defines the world space that you want to track markers within.</span></p>
<p> </p>
<p><span style="font-size:large;">Rotation values are reported as both quaternions, and as roll, pitch, and yaw angles (in degrees). Quaternions are a four-dimensional rotation representation that provide greater mathematical robustness by avoiding "gimbal" points that may be encountered when using roll, pitch, and yaw (also known as Euler angles). However, quaternions are also more mathematically complex and are more difficult to visualize, which is why many still prefer to use Euler angles.</span></p>
<p> </p>
<p><span style="font-size:large;">There are many potential combinations of Euler angles so it is important to understand the order in which rotations are applied, the handedness of the coordinate system, and the axis (positive or negative) that each rotation is applied about.</span></p>
<p> </p>
<p><span style="font-size:large;">These are the conventions used in the API for Euler angles:</span></p>
<ul><li><span style="font-size:large;">Rotation order: XYZ</span></li>
<li><span style="font-size:large;">All coordinates are *right-handed*</span></li>
<li><span style="font-size:large;">Pitch is degrees about the X axis</span></li>
<li><span style="font-size:large;">Yaw is degrees about the Y axis</span></li>
<li><span style="font-size:large;">Roll is degrees about the Z axis</span></li>
<li><span style="font-size:large;">Position values are in millimeters</span></li>
</ul><p> </p>
<p><span style="font-size:large;">To create a transform matrix that converts from world coordinates into the local coordinate system of your chosen rigid body, you will first want to compose the local-to-world transform matrix of the rigid body, then invert it to create a world-to-local transform matrix.</span></p>
<p> </p>
<p><span style="font-size:large;">To compose the rigid body local-to-world transform matrix from values reported by the API, you can first compose a rotation matrix from the quaternion rotation value or from the yaw, pitch, and roll angles, then inject the rigid body translation values.</span></p>
<p><br><br><span style="font-size:large;">Transform matrices can be defined as either "column-major" or "row-major". In a column-major transform matrix, the translation values appear in the right-most column of the 4x4 transform matrix. For purposes of this article, column-major transform matrices will be used. It is beyond the scope of this article, but it is just as feasible to use row-major matrices by transposing matrices.</span></p>
<p> </p>
<p><span style="font-size:large;">In general, given a world transform matrix of the form:</span><br><br><span style="font-size:large;"><tt>M =</tt><tt><br></tt><tt>[ [ ] Tx ]</tt><tt><br></tt><tt>[ [ R ] Ty ]</tt><tt><br></tt><tt>[ [ ] Tz ]</tt><tt><br></tt><tt>[ 0 0 0 1 ]</tt></span><br><br></p>
<p><span style="font-size:large;">where Tx, Tz, Tz are the world-space position of the origin (of the rigid body, as reported from the API), and R is a 3x3 rotation matrix composed as:</span><br><br><span style="font-size:large;"><tt>R = [ Rx (Pitch) ] * [ Ry (Yaw) ] * [ Rz (Roll) ]</tt></span><br><br></p>
<p><span style="font-size:large;">where Rx, Ry, and Rz are 3x3 rotation matrices composed according to:</span></p>
<p><span style="font-size:large;"><img src="/file.php/2445CWXMYWRGGBMAADP0/image072.gif" alt=""></span></p>
<p><span style="font-size:large;"><img src="/file.php/2451BDXJPTWKJPSNXTT0/image074.gif" alt=""></span></p>
<p><span style="font-size:large;"><img src="/file.php/2461MWQJSBABQYNMBBS0/image076.gif" alt=""></span></p>
<p> </p>
<p><span style="font-size:large;">A handy trick to know about local-to-world transform matrices is that once the matrix is composed, it can be validated by examining each column in the matrix. The first three rows of Column 1 are the (normalized) XYZ direction vector of the world-space X axis, column 2 holds the Y axis, and column 3 is the Z axis. Column 4, as noted previously, is the location of the world-space origin.</span></p>
<p><br><br><span style="font-size:large;"> To convert a point from world coordinates (coordinates reported by the API for a 3D point anywhere in space), you need a matrix that converts from world space to local space. We have a local-to-world matrix (where the local coordinates are defined as the coordinate system of the rigid body used to compose the transform matrix), so inverting that matrix will yield a world-to-local transformation matrix.</span></p>
<p><br><br><span style="font-size:large;"> Inversion of a general 4x4 matrix can be slightly complex and may result in singularities, however we are dealing with a special transform matrix that only contains rotations and a translation. Because of that, we can take advantage of the method shown here to easily invert the matrix:</span></p>
<p><br><span style="font-size:large;"><a style="margin:0px;padding:0px;border:0px;font-size:13px;vertical-align:baseline;background-color:#fafafa;color:#3964b9;text-decoration:none;font-family:'Helvetica Neue', Helvetica, Arial, sans-serif;line-height:18px;" href="http://stackoverflow.com/questions/2624422/efficient-4x4-matrix-inverse-affine-transform" target="_blank">http://stackoverflow.com/questions/2624422/efficient-4x4-matrix-inverse-affine-transform</a></span><br><br></p>
<p><span style="font-size:large;">Once the world matrix is converted, multiplying it by the coordinates of a world-space point will yield a point in the local space of the rigid body. Any number of points can be multiplied by this inverted matrix to transform them from world (API) coordinates to local (rigid body) coordinates.</span></p>
<p><span style="font-size:large;">The API includes a sample (markers.sln/markers.cpp) that demonstrates this exact usage.</span></p>
https://help.naturalpoint.com/kb/articles/transform-world-space-coordinates-to-local-rigid-body-coordinates
https://help.naturalpoint.com/kb/articles/2Wed, 22 Jul 2015 08:33:57 +0000