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

admin

. h" H3 I9 E' x) v- n8 {' U# j#include <math.h>
//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
5 I' I5 b# x" v5 f; z" f        int i,j;

( `! S" ]+ H" k2 m; h9 v        for(i=0;i<4;i++)
, D: @$ [+ D& c7 |                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
9 M5 p- V/ ~+ S; P}
//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
4 P9 U1 ?7 Y. r) q{
        int i,j;
3 m! @+ h- x( q8 m9 _+ Q, k! x% e       
        for(i=0;i<4;i++)
" ?9 H8 {- N2 F. t                for(j=0;j<4;j++)
                        if(i==j)
# s) F+ y4 v( }& s0 S6 c                                mtx[i][j]=1.0;
1 K4 q1 f+ d- p& h1 y0 }                        else
' k3 w7 V- W+ k  |/ o' y                                mtx[i][j]=0.0;
/ P; e8 K2 s2 w! E% z0 b8 q% P}
//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{

        int i,j,k;
        double left[4][4],right[4][4];

        Project_Matrix_Copy(left_mtx,left);
% M( s  Y8 X, Z  U        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
" j5 j  B& j5 a+ {                for(j=0;j<4;j++)
: w* ?3 r2 {8 X- h/ H4 z                {
  O6 t' i1 G+ e6 B% W0 Q  i                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
% U. }4 `: r' X6 _6 ]}
//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
8 A# J9 g" B' l% t{
. R' P/ E( B7 S$ w6 D* O, X        int i,j;
        for(i=0;i<4;i++)
1 H* [4 q# v" [! @& Q2 W        {
% v) r& w4 ~9 W8 ~! i/ D1 E0 U                for(j=0;j<4;j++)
2 t2 K/ B+ w- A  z( Z                {
7 x1 A% j; v7 m- p: R                        transpose_mtx[i][j]=mtx[j][i];
% r& r, t, n# W& y" h' P! p                }
        }
}
  t+ c; E" e7 b+ t6 K# d5 \3 W//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{
! b& y+ w. B: a/ c
        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
% }# L. P- a& R! k; P        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
9 U) i- M) J- Q- }: O                if(i==j)
2 B% V9 n7 r) W' h5 n                        pos[i][j]=1.0;
                else
                        pos[i][j]=0.0;
        pos[3][0]+=translation[0];
        pos[3][1]+=translation[1];
9 ^! F+ F8 W1 R; E3 ~        pos[3][2]+=translation[2];
  W- P- ^5 g! t/ G- p}
//向量缩放
+ P6 m/ {; t2 w/ Fvoid Project_Vector_Scale(double a[3],double scale,double b[3])
{
& P# G5 O1 P' z! q" i        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
& Q, P! Z3 X' k# y7 t8 |' t7 Q}

  Q' }: ]8 u) t  f