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

admin

4 z$ u3 Y/ q. s8 h& v6 Y8 x

#include <math.h>
# z% S: t9 a- T$ X5 r//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
9 j, ?1 [2 l/ R7 w+ q$ G{
9 X% x+ e1 o  V& j8 W6 w" s        int i,j;

- C) P9 C2 t: Q2 A/ |# K        for(i=0;i<4;i++)
* e, H- M4 Y- e                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
}
//矩阵初始化
3 G5 Z' o# B+ M# }0 Z5 rvoid Project_Matrix_Identity(double mtx[4][4])
  f8 n) M) `1 l4 n/ j# V{
! R/ A3 Y7 N$ `1 d5 Q: _        int i,j;
       
        for(i=0;i<4;i++)
# y' i5 M* ~. c6 b                for(j=0;j<4;j++)
) _5 ?% f3 w/ {, E. }                        if(i==j)
                                mtx[i][j]=1.0;
                        else
                                mtx[i][j]=0.0;
. Q' Z+ \2 \/ k' y8 ]}
//矩阵相乘
. C  O9 K  Q1 S- }void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
  d; P: s8 h2 D. B% b( n{
  N) Q# H! b% `( C; _
5 \; t& }; a+ W9 v7 D        int i,j,k;
& ^7 X! t+ B: `* O        double left[4][4],right[4][4];
& V% ^0 r9 a& N2 A. d% I* F! A4 Z4 L
        Project_Matrix_Copy(left_mtx,left);
4 V0 _2 G. E/ ^        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
" N2 W" D8 x+ K( M: M                {
                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
$ C0 G; }( {* P% L& \' D                                get_mtx[i][j]+=left[i][k]*right[k][j];
3 I1 M6 S: ]. D0 B4 i0 d' z                }
9 r3 x( p3 Z8 L}
. ]; Y) U4 s8 M8 N//转置矩阵
( H$ f/ F" d: f9 y4 J' Yvoid Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
8 h/ L& K* _0 C{
        int i,j;
; ]9 _+ O, m# z3 {, X  G; k4 r        for(i=0;i<4;i++)
        {
( {( m9 \# d$ H8 a; B$ |$ Y( J: x                for(j=0;j<4;j++)
- _- c9 b! @; j. y1 E' \5 r; Y                {
4 v: k/ x0 O. x5 h; l                        transpose_mtx[i][j]=mtx[j][i];
                }
        }
}
% O5 q6 c. G9 ~( W& I: C8 [//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
% g/ Y4 Z9 {3 c& J7 J% a5 N1 i{

        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
+ K! J# E' ^* u- n' }3 l( _) _        int i,j;
. |  d* o# u1 b( m        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
                if(i==j)
                        pos[i][j]=1.0;
, |# `  o1 T* \3 R9 N2 ^) g: b                else
                        pos[i][j]=0.0;
+ g9 {" d% J1 Q- x# v/ V        pos[3][0]+=translation[0];
7 Y% K& v" m  E4 q        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
$ A# P" N/ J" A0 w' h2 U9 Z}
//向量缩放
3 e: J' D$ [3 P( M. y2 I( s1 R! ivoid Project_Vector_Scale(double a[3],double scale,double b[3])
& Z$ L2 J9 F, Z! \{
- @5 v) P* p, G' s2 R) i, |# I4 N        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
}