Specific Vector Transformations (GPS) Part 2

Transformation: Vehicle to Navigation Frame

Consider the situation shown in Figure 2.13, which depicts two coordinate systems. The first coordinate system, denoted by (n, e, d), is the geographic frame. The second coordinate system, denoted by (u,v,w) is the vehicle body frame which is at an arbitrary orientation relative to the geographic frame2.

The relationship between vectors in the body and geographic reference frames can be completely described by the rotation matrixtmp20-401_thumb_thumbThis rotation matrix can be defined by a series of three plane rotations involving thetmp20-402_thumb_thumbwheretmp20-403_thumb_thumbrepresents roll,tmp20-404_thumb_thumbrepresents pitch, and tmp20-405_thumb_thumbrepresents yaw angle4.


In Figures 2.14-2.16, the axes of the geographic frame are indicated by the I, J, and K unit vectors.

The first rotation, as shown in Figure 2.14, rotates the geographic coordinate system by ^ radians about the geographic frame d-axis (i.e., K unit vector). This rotation aligns the new I’-axis with the projection of the vehicle u-axis onto the tangent plane to the ellipsoid. The plane rotation for this operation is described as tmp20-411_thumb_thumb

where

tmp20-412_thumb_thumb

The resultant I’ and J’-axes still lie in the north-east tangent plane.

The second rotation, as shown in Figure 2.15, rotates the coordinate system that resulted from the previous yaw rotation by 0 radians about the

Relation between vehicle and navigation frame coordinate systems. For navigation in the geographic frame, the origin of the ned coordinate axes would be at the projection of the vehicle frame origin onto the ellipsoid. For navigation in a local tangent frame, the origin of the ned coordinate axes would be at some convenient point near the area of operation.

Figure 2.13: Relation between vehicle and navigation frame coordinate systems. For navigation in the geographic frame, the origin of the ned coordinate axes would be at the projection of the vehicle frame origin onto the ellipsoid. For navigation in a local tangent frame, the origin of the ned coordinate axes would be at some convenient point near the area of operation.

Result of yaw rotation. The initial I, J, K unit vectors align with the tangent frame (n,e,d) directions.

Figure 2.14: Result of yaw rotation. The initial I, J, K unit vectors align with the tangent frame (n,e,d) directions.

Result of pitch rotation. The resultant I" unit vector aligns with the vehicle u-axis.

Figure 2.15: Result of pitch rotation. The resultant I" unit vector aligns with the vehicle u-axis.

Result of roll rotation. The finalunit vectors align with the vehicle u,v,w directions.

Figure 2.16: Result of roll rotation. The finaltmp20-417_thumb_thumbunit vectors align with the vehicle u,v,w directions.

tmp20-419_thumb_thumbThis rotation aligns the newtmp20-420_thumb[2]with the vehicle u-axis. The plane rotation for this operation is described as

tmp20-424_thumb[2]

The third rotation, as shown in Figure 2.16, rotates the coordinate systemthat resulted from the previous pitch rotation by $ radians about thetmp20-425_thumb[2]This rotation aligns the newtmp20-426_thumb[2]with the vehicle v and w axes, respectively. The plane rotation for this operation is described as

tmp20-431_thumb[2]

where

tmp20-432_thumb[2]

Therefore, vectors represented in geographic frame (or in the local tangent plane) can be transformed into a vehicle frame representation by the series of three rotations:tmp20-433_thumb[2]

tmp20-435_thumb[2]

where the notationtmp20-436_thumb[2]The inverse vector trans formation is

tmp20-439_thumb[2]

Example 2.5 The velocity of a vehicle in the body frame is measured to be

tmp20-440_thumb[2]The attitude of the vehicle istmp20-441_thumb[2] What is the instantaneous rate of change of the vehicle position in the local (geographic) tangent plane reference frame? In this case,

tmp20-444_thumb[2]

Therefore, the vehicle velocity relative to the tangent plane reference system is

tmp20-445_thumb[2]

Once a sequence of rotations (in this case zyx) is specified, the rotation angle sequence to represent a given relative rotational orientation is unique except at points of singularity. Note for example that for the zyx sequence of rotations, the rotational sequencetmp20-446_thumb[2]yields the same orientation for anytmp20-447_thumb[2]Thisdemonstrates that the zyx sequence of rotations is singular points attmp20-448_thumb[2]These are the only points of singularity of the zyx sequence of rotations.

The above zyx rotation sequence is not the only possibility. Other rotation sequences are in use due to the fact that the singularities will occur at different locations. The zyx sequence is used predominantly in this topic. In land or sea surface-vehicle applications the singular point (hopefully) does not occur. In other applications, alternative Euler angle sequences may be used. Also, singularity free parameterizations, such as the quaternion, offer attractive alternatives.

When the matrix Rg is known, the Euler angles can be determined, for control or planning purposes, by the following equations

tmp20-452_thumb[2]

where atan2(y, x) is a four quadrant inverse tangent function and the numbers in square brackets refer to a specific element of the matrix. For example,tmp20-453_thumb[2]is the element in the i-th row and j-th column of matrix A.

This section has alluded to the fact that the rotation matricestmp20-454_thumb[2] would have the same form. This should not be interpreted as meaning that the matrices or the Euler angles are the same. The Euler angles relative to a fixed tangent plane will be distinct from the Euler angles defined relative to the geographic frame. Also, the angular ratestmp20-455_thumb[2]are distinct.

We have that

tmp20-459_thumb[2]

The vectortmp20-460_thumb[2]whiletmp20-461_thumb[2]can be non-zero as discussed in Example 2.6.

Transformation: Orthogonal Small Angle

Subsequent discussions will frequently consider small angle transformations. A small angle transformations, is the transformation between two coordinate systems differing infinitesimally in relative orientation. For example, in discussing the time derivative of a direction cosine matrix, it will be convenient to consider the small angle transformation between the direction cosine matrices valid at two infinitesimally different instants of time. Also, in analyzing INS error dynamics it will be necessary to consider transformations between physical and computed frames-of-reference, where the error (at least initially) is small. In contrast, Euler angles define finite angle rotational transformations.

Consider coordinate systems a and b where frame b is obtained from frame a by the infinitesimal rotationstmp20-464_thumb[2]about the third axis of the a frame,tmp20-465_thumb[2]about the second axis of the resultant frame of the first rotation, andtmp20-466_thumb[2]about the first axis of the resultant frame of the second rotation. Denote this infinitesimal rotation bytmp20-467_thumb[2]The vector transformation from frame a to frame b is defined by the series of three rotations:tmp20-468_thumb[2]Due to the fact that each angle is in finitesimal (which implies thattmp20-469_thumb[2] fortmp20-470_thumb[2]the order in which the rotations occur will not be important. The matrix representation of the vector transformation is

tmp20-478_thumb[2]

wheretmp20-479_thumb[2]is the skew symmetric representation oftmp20-480_thumb[2]as defined in eqn. (B.15). To first order, the inverse rotation is

tmp20-483_thumb[2]

Next post:

Previous post: