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

admin

" d6 u. S3 `6 u/ {6 S4 a
. u6 }/ r& I9 [  w% t: N% d#include <math.h>
//矩阵复制
; {( w$ @( {' v2 d  r+ Evoid Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
        int i,j;

+ Q. j: ]* x" v4 L0 V& _+ N' C        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
+ ]0 S" {  A# M4 x* a  z                        to_mtx[i][j]=from_mtx[i][j];
}
' c( A2 c2 `; Y. u7 x! P5 O5 ]//矩阵初始化
$ I3 ?) S5 l" X$ w# `+ ]void Project_Matrix_Identity(double mtx[4][4])
2 ?6 [# I) B) R7 [" X{
        int i,j;
( u: S; w. m/ z! Z+ K  ~* Y       
/ F' ^, ]& ]  s. X2 I  ~        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        if(i==j)
                                mtx[i][j]=1.0;
* E% \( i$ l4 v2 P% |4 ]$ ]                        else
                                mtx[i][j]=0.0;
}
//矩阵相乘
5 _8 D) w/ L+ n+ G. kvoid Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{

7 I; e2 y/ j( V6 q        int i,j,k;
( s. [7 b& I" M& U3 W% n1 g        double left[4][4],right[4][4];
8 C& }. y: m0 q- q, C! n6 `% M! @
" U7 M, V9 E. R# {! b0 V1 x9 y- v- s        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
/ \% x& _) N& @' P& f        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
( G7 q- A/ u2 v% Y9 v2 v                {
" e( t! Z0 k  P+ R                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
1 b3 r/ \: z6 k& e/ U- z/ r                }
}
8 L$ I: ~( [7 N2 O- M//转置矩阵
% A: z+ R& z* `8 K  u! c$ dvoid Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
+ m" X# }: ?# Q0 Y{
        int i,j;
        for(i=0;i<4;i++)
        {
                for(j=0;j<4;j++)
2 I3 v+ |% I; h' p                {
                        transpose_mtx[i][j]=mtx[j][i];
' r( \; O. O, d/ w/ M: Z& K$ n                }
  U. ~* E! n5 u: s' W* |" T        }
1 I1 p2 d/ Z: G, j. P+ S4 n}
//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{

        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
" v0 k# ]0 p, L        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
( J/ T5 S0 R2 ]/ w; B* H. V                if(i==j)
+ z  F9 x" i( i9 K) q1 a  K                        pos[i][j]=1.0;
6 J6 [8 R4 {" {9 K* J1 R                else
                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
- j4 Z/ U3 D1 y/ h4 _        pos[3][1]+=translation[1];
. j  r4 L' ~$ `/ W        pos[3][2]+=translation[2];
  y& n4 Q: [' {  N, W6 t}
( |  v( R2 q' \//向量缩放
) \; a5 V  C. L# a& Uvoid Project_Vector_Scale(double a[3],double scale,double b[3])
{
9 S; n0 f  p/ x, {) A        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
6 @/ _( j  D' {: [1 D8 Q}
: ~$ b- v1 ^1 d4 |5 c% g! L6 j# @* D