trick/trick_source/trick_utils/math/src/dm_sub.c

53 lines
2.5 KiB
C
Raw Normal View History

2015-02-26 15:02:31 +00:00
/*******************************************************************************
* *
* Trick Simulation Environment Software *
* *
* Copyright (c) 1996,1997 LinCom Corporation, Houston, TX *
* All rights reserved. *
* *
* Copyrighted by LinCom Corporation and proprietary to it. Any unauthorized *
* use of Trick Software including source code, object code or executables is *
* strictly prohibited and LinCom assumes no liability for such actions or *
* results thereof. *
* *
* Trick Software has been developed under NASA Government Contracts and *
* access to it may be granted for Government work by the following contact: *
* *
* Contact: Charles Gott, Branch Chief *
* Simulation and Graphics Branch *
* Automation, Robotics, & Simulation Division *
* NASA, Johnson Space Center, Houston, TX *
* *
*******************************************************************************/
/*
PURPOSE: (Matrix subtraction)
ASSUMPTIONS AND LIMITATIONS: ((3x3 Matrix implementation))
PROGRAMMERS: (((Les Quiocho) (NASA/Johnson Space Center) (Jan 1990) (v1.0) (Init Release))) */
/*
* $Id: dm_sub.c 49 2009-02-02 22:37:59Z lin $
*/
#include "../include/trick_math.h"
void dm_sub(double diff[3][3], /* Out: Difference of the two matrices */
double mat1[3][3], /* In: Matrix 1 */
double mat2[3][3])
{ /* In: Matrix 2 */
diff[0][0] = mat1[0][0] - mat2[0][0];
diff[0][1] = mat1[0][1] - mat2[0][1];
diff[0][2] = mat1[0][2] - mat2[0][2];
diff[1][0] = mat1[1][0] - mat2[1][0];
diff[1][1] = mat1[1][1] - mat2[1][1];
diff[1][2] = mat1[1][2] - mat2[1][2];
diff[2][0] = mat1[2][0] - mat2[2][0];
diff[2][1] = mat1[2][1] - mat2[2][1];
diff[2][2] = mat1[2][2] - mat2[2][2];
return;
}