mirror of
https://github.com/nasa/trick.git
synced 2025-05-07 19:18:11 +00:00
Reorganized. Created a new top level include directory that will hold all of Trick's header files. Moved all of the Trick headers to this directory. Created a libexec directory that holds all of the executables that users don't need to execute directly. Changed all of the executables remaining in bin to start with "trick-". In the sim_services directories changed all source files to find the Trick headers in their new location. Since all of the include files are gone in sim_services, removed the src directories as well, moving all of the source files up a level. Moved the makefiles, docs, man, and other architecture independent files into a top level share directory. Renamed lib_${TRICK_HOST_CPU} to lib64 or lib depending on the platform we're currently on. refs #63
32 lines
1.3 KiB
C
32 lines
1.3 KiB
C
/*
|
|
PURPOSE: (Matrix times matrix transpose)
|
|
|
|
ASSUMPTIONS AND LIMITATIONS: ((3x3 Matrix implementation))
|
|
|
|
PROGRAMMERS: (((Les Quiocho) (NASA/JSC) (Jan 1990) (v1.0) (Init Release))) */
|
|
|
|
#include "trick/trick_math.h"
|
|
|
|
void dmxmt(double prod[3][3], /* Out: Product of the two matrices */
|
|
double mat1[3][3], /* In: Matrix 1 */
|
|
double mat2[3][3])
|
|
{ /* In: Matrix 2 */
|
|
double trans[3][3];
|
|
|
|
dm_trans(trans, mat2);
|
|
|
|
prod[0][0] = mat1[0][0] * trans[0][0] + mat1[0][1] * trans[1][0] + mat1[0][2] * trans[2][0];
|
|
prod[0][1] = mat1[0][0] * trans[0][1] + mat1[0][1] * trans[1][1] + mat1[0][2] * trans[2][1];
|
|
prod[0][2] = mat1[0][0] * trans[0][2] + mat1[0][1] * trans[1][2] + mat1[0][2] * trans[2][2];
|
|
|
|
prod[1][0] = mat1[1][0] * trans[0][0] + mat1[1][1] * trans[1][0] + mat1[1][2] * trans[2][0];
|
|
prod[1][1] = mat1[1][0] * trans[0][1] + mat1[1][1] * trans[1][1] + mat1[1][2] * trans[2][1];
|
|
prod[1][2] = mat1[1][0] * trans[0][2] + mat1[1][1] * trans[1][2] + mat1[1][2] * trans[2][2];
|
|
|
|
prod[2][0] = mat1[2][0] * trans[0][0] + mat1[2][1] * trans[1][0] + mat1[2][2] * trans[2][0];
|
|
prod[2][1] = mat1[2][0] * trans[0][1] + mat1[2][1] * trans[1][1] + mat1[2][2] * trans[2][1];
|
|
prod[2][2] = mat1[2][0] * trans[0][2] + mat1[2][1] * trans[1][2] + mat1[2][2] * trans[2][2];
|
|
|
|
return;
|
|
}
|