UG NX二次开发源码分享：矩阵操作的基础算法代码

admin

- Y. i9 z1 m" o; ^: B

#include <math.h>
( @* `! Q+ e) _% W' V4 J; J: }//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
/ b4 Y7 H# z/ ]4 s{
1 {* l8 M: l% U( J( X1 V4 q+ C        int i,j;
. ^3 e  R3 q( V
0 R% ~" |/ j* G2 w7 H& ]8 G        for(i=0;i<4;i++)
, [1 {* Q, A' ^                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
}
//矩阵初始化
) l+ K6 l/ Q% I1 avoid Project_Matrix_Identity(double mtx[4][4])
{
        int i,j;
& A2 l8 c. D; R: J8 ^9 ^; t9 r2 d       
* A% i' S* v1 i& f% A        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        if(i==j)
7 v( b* z" x& u% R8 I( b                                mtx[i][j]=1.0;
8 [3 D1 e) f4 |1 e                        else
                                mtx[i][j]=0.0;
3 Y: g1 {# L5 @& M/ k! e4 g' z! }0 P}
$ d! [* w, x% |: z! Q//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
8 o# y! ^% z' R3 {% o{
( }* |3 d& Y& S% [
        int i,j,k;
        double left[4][4],right[4][4];

        Project_Matrix_Copy(left_mtx,left);
2 x4 V5 v6 v5 h, d  e9 y        Project_Matrix_Copy(right_mtx,right);
- q( j! R  |' e/ x/ F        for(i=0;i<4;i++)
% a  ~, s5 R3 a4 _# Y7 v                for(j=0;j<4;j++)
( s% C* W& b3 e; g  B$ c7 v                {
                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
, u$ r+ Q9 E# |# L8 ]                                get_mtx[i][j]+=left[i][k]*right[k][j];
2 M" Z4 v7 }  N                }
}
  H4 |) S5 _8 F" Q  U! M//转置矩阵
4 ~4 b9 \8 \& ~. Xvoid Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
: Z0 b) T2 ^- a3 v5 Z& Q) j{
        int i,j;
        for(i=0;i<4;i++)
        {
4 }# O2 \  f/ w                for(j=0;j<4;j++)
                {
' a" m9 e4 @" l7 u6 @2 [8 r3 ~7 z* w                        transpose_mtx[i][j]=mtx[j][i];
                }
        }
# G5 ~  ~9 h# S8 s( l. \}
: d0 ]. X) F& [. |6 a+ Z//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{
# H) {! M3 w  X' W3 J
        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
: [6 [% `  ~2 A8 K        int i,j;
! B  y" R7 m. c( B$ U8 }& T        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
                if(i==j)
7 C  f' c1 ?+ N5 l+ v1 Z                        pos[i][j]=1.0;
                else
                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
* p/ g' j% n! @7 Q  B, O' x0 ?        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
# \/ z1 J8 K# v! }( _6 c, e) W}
. v! E; ^) _( m8 ?5 a2 Y//向量缩放
void Project_Vector_Scale(double a[3],double scale,double b[3])
  Y' t* C( p  j1 W4 A: a6 \0 S% d$ I{
1 H  a. u% U' ?3 O! A5 T3 s1 ]        b[0]=a[0]*scale;
2 ^' Z" [& D" K& C5 {5 f        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
}

6 Z! S* [0 |+ e, t& l