Electromagnetic motion sensors typically provide with their positions and orientations at a given instant in real time. Assuming each sensor represents a rigid body, the location of the origin and the orientation of the local reference frame each sensor represents are readily available. From [41] of the Helical (Screw) Axis page:
where Pi = the reference frame of the linked
proximal segment (fixed body) in frame i, Di = the reference frame of the
linked distal segment (moving body) in frame i,
where TA/G = the transformation matrix from the global reference frame to frame A. The transformation matrices from the global (inertial) frame to the local (segmental) reference frames are the immediate output of the motion sensors. From [1] and [2]:
For a multi-DOF joint formed by two segments, proximal and
distal, let vector
where
where The relative positions of the distal sensor to the proximal sensor in frames i and i+1 suffice the following relationship:
where
In [6] it was assumed that
there is no relative translation between the proximal and distal segments. [6]
actually provides with 3 equations and by expanding [6]
to N - 1 intervals a total of 3 * (N - 1) linear equations of
The position of the center of the multi-DOF joint observed
in the proximal reference frame ( Once
where |
© Young-Hoo Kwon, 1998- |