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

admin

6 w0 O8 z8 w/ a2 l; }6 u

0 m# U1 m( E" Z& o" r& ]0 Q( o, S#include <math.h>
% Z$ P& T) w3 }2 Z//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
: w/ i( a8 O$ I7 h" k( M; Z        int i,j;
6 w1 _5 w$ ~. k( K
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
/ j* N6 H/ Q' {3 X+ W                        to_mtx[i][j]=from_mtx[i][j];
, u* v% _) O/ n% q+ x}
//矩阵初始化
2 {( f* s8 G" c* v. o, evoid Project_Matrix_Identity(double mtx[4][4])
{
        int i,j;
( l0 ]1 h1 ?. \8 U5 j       
        for(i=0;i<4;i++)
7 I2 l5 ?3 O& d& T( V8 |# R& c* _                for(j=0;j<4;j++)
6 S; ?3 z2 [- v% R; X                        if(i==j)
: d1 B9 j9 l" b7 M( d7 b; z2 H                                mtx[i][j]=1.0;
+ w, V' [7 v/ ~0 X- m' Y                        else
                                mtx[i][j]=0.0;
}
( a1 y- C/ \) t& `% e" q8 h//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
" Q# u. }4 L) m0 D* d. O' ?{

        int i,j,k;
/ A  X1 g! v6 E3 ?& X/ x        double left[4][4],right[4][4];
4 d" a, W+ d% {; h$ E
/ }3 I% p% e. z9 @        Project_Matrix_Copy(left_mtx,left);
+ s8 N8 d& \1 c! g6 R- r* b        Project_Matrix_Copy(right_mtx,right);
" I" ~* S5 C8 |5 {  v, K        for(i=0;i<4;i++)
6 m$ v$ r0 k" M8 T4 q8 S- P9 }                for(j=0;j<4;j++)
                {
& c0 C2 S& X. \& q                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
  M9 l) I3 w3 I}
//转置矩阵
; `6 `8 t/ k$ e; N3 Uvoid Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
' m- K# K, p. A8 W( R) x{
3 O: w0 T# B+ }* n! [        int i,j;
        for(i=0;i<4;i++)
5 s% T& A0 P& M2 i$ _        {
                for(j=0;j<4;j++)
                {
/ G/ v, a  y5 ]: t0 f                        transpose_mtx[i][j]=mtx[j][i];
                }
        }
}
//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{

/ G2 p3 e, b; Z3 ~8 o# }3 A        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
9 b4 r, Q, i; d- T, D$ a2 A& k        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
                if(i==j)
                        pos[i][j]=1.0;
                else
$ j( R' B9 A0 {9 S7 h2 A0 c/ y/ d                        pos[i][j]=0.0;
) A" V: a& R$ @) m! R        pos[3][0]+=translation[0];
        pos[3][1]+=translation[1];
; G8 x* |( R+ e7 K: ?        pos[3][2]+=translation[2];
}
- L# e6 P9 O! `//向量缩放
void Project_Vector_Scale(double a[3],double scale,double b[3])
+ y$ L  R$ `4 r" Y8 a, {5 K5 R{
, g: W( \  |# _# u# I        b[0]=a[0]*scale;
1 m, m! s0 [( y% o- o7 q% J6 ~0 S        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
9 F. `' x! ~$ P# Q}