Alex Lin 19025d77ad Standardize directory names
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
2015-06-09 08:44:42 -05:00

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;
}