isrot |
Table of contents
ProcedureISROT ( Indicate whether a matrix is a rotation matrix ) LOGICAL FUNCTION ISROT ( M, NTOL, DTOL ) AbstractIndicate whether a 3x3 matrix is a rotation matrix. Required_ReadingROTATION KeywordsERROR MATRIX ROTATION DeclarationsIMPLICIT NONE DOUBLE PRECISION M ( 3, 3 ) DOUBLE PRECISION NTOL DOUBLE PRECISION DTOL Brief_I/OVARIABLE I/O DESCRIPTION -------- --- -------------------------------------------------- M I A matrix to be tested. NTOL I Tolerance for the norms of the columns of M. DTOL I Tolerance for the determinant of a matrix whose columns are the unitized columns of M. The function returns .TRUE. if and only if M is a rotation matrix. Detailed_InputM is a 3x3 matrix to be tested. NTOL is the tolerance for the norms of the columns of M. DTOL is the tolerance for the determinant of a matrix whose columns are the unitized columns of M. Detailed_OutputThe function returns .TRUE. if and only if M is found to be a rotation matrix. The criteria that M must meet are: 1) The norm of each column of M must satisfy the relation 1.D0 - NTOL < || column || < 1.D0 + NTOL - - 2) The determinant of the matrix whose columns are the unitized columns of M must satisfy 1.D0 - DTOL < determinant < 1.D0 + DTOL - - ParametersNone. Exceptions1) If either of NTOL or DTOL is negative, the error SPICE(VALUEOUTOFRANGE) is signaled. ISROT returns the value .FALSE. in this case. FilesNone. ParticularsThis routine is an error checking `filter'; its purpose is to detect gross errors, such as uninitialized matrices. Matrices that do not pass the tests used by this routine hardly qualify as rotation matrices. The test criteria can be adjusted by varying the parameters NTOL and DTOL. A property of rotation matrices is that their columns form a right-handed, orthonormal basis in 3-dimensional space. The converse is true: all 3x3 matrices with this property are rotation matrices. An ordered set of three vectors V1, V2, V3 forms a right-handed, orthonormal basis if and only if 1) || V1 || = || V2 || = || V3 || = 1 2) V3 = V1 x V2. Since V1, V2, and V3 are unit vectors, we also have < V3, V1 x V2 > = 1. This quantity is the determinant of the matrix whose columns are V1, V2 and V3. When finite precision numbers are used, rotation matrices will usually fail to satisfy these criteria exactly. We must use criteria that indicate approximate conformance to the criteria listed above. We choose 1) | || Vi || - 1 | < NTOL, i = 1, 2, 3. - 2) Let Vi Ui = ------ , i = 1, 2, 3. ||Vi|| Then we require | < U3, U1 x U2 > - 1 | < DTOL; - equivalently, letting U be the matrix whose columns are U1, U2, and U3, we insist on | det(U) - 1 | < DTOL. _ Examples1) We have obtained an instrument pointing matrix C from a C-kernel, and we wish to test whether it is in fact a rotation matrix. We can use ISROT to check this: C C Obtain pointing matrix: C CALL CKGP ( INST, TIMEIN, TOL, REF, C, TIMOUT, FOUND ) C C Verify that C is a rotation: C IF ( .NOT. ISROT ( C ) ) THEN [ perform exception handling ] ELSE [ code for the normal case goes here ] END IF RestrictionsNone. Literature_ReferencesNone. Author_and_InstitutionN.J. Bachman (JPL) J. Diaz del Rio (ODC Space) H.A. Neilan (JPL) W.L. Taber (JPL) VersionSPICELIB Version 1.2.0, 17-JUN-2021 (JDR) Added IMPLICIT NONE statement. Edited the header to comply with NAIF standard. SPICELIB Version 1.1.0, 17-MAY-1994 (HAN) If the value of the function RETURN is .TRUE. upon execution of this module, this function is assigned a default value of either 0, 0.0D0, .FALSE., or blank depending on the type of the function. SPICELIB Version 1.0.1, 10-MAR-1992 (WLT) Comment section for permuted index source lines was added following the header. SPICELIB Version 1.0.0, 06-SEP-1990 (NJB) |
Fri Dec 31 18:36:29 2021