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

admin

6 n- q+ z! G4 g6 ~, r& j7 P/ L

, l* }: X2 p# r6 D' v#include <math.h>
" Y4 F3 \- v8 U8 I2 g//矩阵复制
: I- r, w. k/ w# g. pvoid Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
. _6 A) k& O. I( {: i/ y{
        int i,j;

        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
! Z9 H/ D  U) f! V( [2 S2 ^% j}
" {1 p( T: Y2 t; B1 A1 J//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
5 R0 M3 u6 b1 e2 q) f' o( M{
: g4 j2 _! i+ p6 h" d        int i,j;
5 K, w' X% S9 p: ]- A2 o       
+ D2 d# z) R; r2 g( g        for(i=0;i<4;i++)
: G- \2 K2 ]2 w6 [                for(j=0;j<4;j++)
9 n& T, G; V. _4 x1 ]                        if(i==j)
1 t4 y4 u! ]: N9 g* V                                mtx[i][j]=1.0;
, e# e7 a) D: s0 |                        else
+ |1 n3 W0 M* n/ @6 J                                mtx[i][j]=0.0;
2 w: @2 o- ?% a& m; y$ {+ u6 [% G}
3 V' c1 Y$ q- W: ~! U& I//矩阵相乘
7 n% y/ h5 k$ lvoid Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
' T; o8 Y' o! P{
& l' ?( p7 @9 P' u7 [$ o' P
% y1 {. E" l2 r1 L        int i,j,k;
        double left[4][4],right[4][4];

        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
8 q* {# z; F9 a+ v        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                {
                        get_mtx[i][j]=0.0;
                        for(k=0;k<4;k++)
( w% R- Q$ S- b5 v( b# T. D3 o                                get_mtx[i][j]+=left[i][k]*right[k][j];
9 K! J' A( V. H3 y# f) x                }
1 M* s7 u& X  T3 ~' C* U}
- j; u3 s) o& J//转置矩阵
3 @& G, C( w, u6 @4 @# D- Qvoid Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
        int i,j;
        for(i=0;i<4;i++)
        {
                for(j=0;j<4;j++)
% `& `0 B, D9 L                {
  q: @) j) T7 _: _3 L. ~' Z                        transpose_mtx[i][j]=mtx[j][i];
) A, _; q( n; N& N' g: w8 G6 ]                }
        }
( H# a4 v( [/ [% `}
  ^* n0 t4 p0 m//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
7 z; I, Y( c- O; g9 ~0 x{

        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
, x/ f' Y$ i9 }2 j' y        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
* y& \# |% A0 O; s# d: \                if(i==j)
                        pos[i][j]=1.0;
                else
" [* j$ ~0 D$ |                        pos[i][j]=0.0;
! x/ E* j7 h9 s- E        pos[3][0]+=translation[0];
        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
}
+ ^" }% \# C+ }4 l% ~8 S//向量缩放
) m4 C! E3 G6 s8 \, B2 `: D' Jvoid Project_Vector_Scale(double a[3],double scale,double b[3])
  W% V' e% V9 S+ Y% ?: q1 @" V{
        b[0]=a[0]*scale;
& Z! L5 _1 f6 w" s/ A& \        b[1]=a[1]*scale;
        b[2]=a[2]*scale;
9 A( {0 M3 D: d  ?}