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

admin

#include <math.h>
//矩阵复制
, e) r) Q' Y4 V5 f. ~8 C4 M+ evoid Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
        int i,j;
5 @: F5 J. f* I0 a$ v
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
( S; x) I, U1 P& H" w- r                        to_mtx[i][j]=from_mtx[i][j];
}
//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
{
: r; g; i& ~" a9 m- `# Q        int i,j;
& D' Z2 R( |2 _; L       
! _7 i! F- F" g* m) l        for(i=0;i<4;i++)
% [: ~% D; b" G. Y                for(j=0;j<4;j++)
                        if(i==j)
' C9 V9 p6 ^, i$ E% `7 T$ |0 A5 [5 f                                mtx[i][j]=1.0;
! _) z, Z4 t- i% R! P! a                        else
* r1 D6 \/ y. l2 K  c                                mtx[i][j]=0.0;
}
//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{

7 _( O/ e/ g3 h6 l" t0 v7 _! J        int i,j,k;
        double left[4][4],right[4][4];

, K( c/ H' h8 C7 `- q( e        Project_Matrix_Copy(left_mtx,left);
2 S9 N7 U" J+ Q* n        Project_Matrix_Copy(right_mtx,right);
, h7 T" I- d" ^( p: v- z4 n( n        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                {
/ i: s8 o; [# @2 ]+ s: D# z! w                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
- x$ e; o( ^& W7 r% l                                get_mtx[i][j]+=left[i][k]*right[k][j];
4 J, m9 }2 N0 ~2 j, A2 M                }
, r3 z2 `3 K- |/ e3 l}
- R- t+ M4 b- @" B8 @0 p) ~//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
8 E3 v% ?% [6 ]% I  B% k{
# G8 ?( a$ r- M7 S" r        int i,j;
+ f/ I) f9 ^6 d# ~; w        for(i=0;i<4;i++)
" E, p! M: k* v( o5 C8 R1 k- L6 q2 a' G" P        {
, i0 L* [, W4 F8 A9 [                for(j=0;j<4;j++)
                {
                        transpose_mtx[i][j]=mtx[j][i];
                }
        }
3 b+ z4 {: F, v* a) y2 m4 l3 d2 b! V; ]' T}
. Q* ]# q/ }' k1 w//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
& h2 I( q6 A2 F3 [& A) }* `; i' v8 J{

: o1 k; N' w# }' E        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
% c0 b1 `1 u$ W/ l' Y5 m# f) x9 `        int i,j;
        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
                if(i==j)
                        pos[i][j]=1.0;
* b  O1 K+ a1 H/ [8 Z- H                else
3 q) J, J) @2 H0 N2 u& k$ y                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
4 {, s) Z: k& I. q5 M5 Y- |        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
}
//向量缩放
4 k7 M2 t3 U! x) Kvoid Project_Vector_Scale(double a[3],double scale,double b[3])
{
        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
}
4 ?$ n" G& r. ^$ f! i
' k+ i, E% z  Z7 z3 W* y