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

admin

1 ]+ I3 j- M5 Y9 {7 T7 i+ o( U

! o/ s% K6 d) Q; q1 ]#include <math.h>
, c% i4 V2 g* k9 ]//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
6 j3 p: D3 k/ `' @  a        int i,j;
5 p7 q3 u4 E/ r5 b+ ]5 Q% |; x0 z
) e" f# y, j" U6 C        for(i=0;i<4;i++)
9 d) I+ c  v( r8 {                for(j=0;j<4;j++)
) j% {, k: i9 d' {" a7 M' R. u2 j. J                        to_mtx[i][j]=from_mtx[i][j];
}
, m4 \' x- G& J//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
2 e7 U5 n: i! w( ~& u) u  F{
/ o8 r0 N. V% b9 Y/ G% s) ^, z- y        int i,j;
* R8 [/ Z/ g: B( i) q- P) m  z2 i       
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        if(i==j)
! W& l+ @- B9 S* @! h& M                                mtx[i][j]=1.0;
/ D  G" W3 w. v: j( K8 L- T  f) D                        else
7 W: q! W5 K& O8 n                                mtx[i][j]=0.0;
}
# x1 ~/ E  b3 ~+ j' F//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
* w3 c$ ^% i$ y0 z{
' \( s6 Q2 v/ ?" l/ Q1 G0 `
" [& K+ [2 _0 j: @6 Z2 }4 h        int i,j,k;
        double left[4][4],right[4][4];

+ T/ v% ~: I% \! p+ W        Project_Matrix_Copy(left_mtx,left);
: x+ o2 f; e& K0 I, H$ D: `        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
) S. P3 i0 s; R3 {1 Q1 s% R                for(j=0;j<4;j++)
                {
                        get_mtx[i][j]=0.0;
$ \4 m7 Y0 N# v- ^$ I                        for(k=0;k<4;k++)
! M, o. X& |$ Q                                get_mtx[i][j]+=left[i][k]*right[k][j];
) x$ S* {+ Y8 B; y6 F                }
; {3 i* @  R* [! s, X% H% q}
+ r) a5 d; e% p( l- R' t//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
! n" N4 s0 P6 ~. a" M{
        int i,j;
- a3 p3 P6 `: O        for(i=0;i<4;i++)
0 J1 W; [7 D  @" b' s# b, H        {
3 B4 k4 S! X% ?3 s$ Z2 g                for(j=0;j<4;j++)
                {
                        transpose_mtx[i][j]=mtx[j][i];
- B  a' [8 e, x: Z% H, y  }* E7 Y                }
, S3 V2 b( f6 k$ @. }6 A        }
}
//从11元组获取变换矩阵
2 W9 N# t& D) |9 Q0 j$ Vvoid Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
" @3 \# k& q1 t4 |0 r3 C2 K' _3 v9 i% J8 M{
+ q) {' Z& o( o* c
& O# r% c, O1 ~        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
6 r) j! T+ ~- \0 I; r/ p8 H. q        int i,j;
        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
/ o/ [  F. ]( v& Y: y: m                if(i==j)
                        pos[i][j]=1.0;
- U8 j' G) J6 |/ s" t. i: p                else
                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
* k+ C4 K; A' ^        pos[3][1]+=translation[1];
# g7 h% v; }' O1 T4 u        pos[3][2]+=translation[2];
}
//向量缩放
void Project_Vector_Scale(double a[3],double scale,double b[3])
* M. s9 |1 V9 h  @- {{
        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
7 N& M. _- k) S  L        b[2]=a[2]*scale;
# S. |9 s; N" R7 h  t}

+ J9 o5 m4 q" c1 f4 ^  h