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

admin

, @+ X* y- P) }# q' t& S#include <math.h>
2 {: v( V8 V. [7 R& o- }: i//矩阵复制
& o  q. U0 l9 t0 \; F* f+ ivoid Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
* d! |/ A5 z, P6 F{
        int i,j;

        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
- L5 Q5 t/ e/ y2 y) ~                        to_mtx[i][j]=from_mtx[i][j];
3 _) A0 y  S0 X9 e0 M, S/ Y}
//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
{
        int i,j;
* t2 o$ u. ?& l7 f' H       
        for(i=0;i<4;i++)
, P2 k! O3 s+ H0 G- |                for(j=0;j<4;j++)
* I+ M+ S1 k/ L  O, g  Y' f" b                        if(i==j)
                                mtx[i][j]=1.0;
, R5 q% K& a1 S8 {- o                        else
2 V# L$ K! k8 n& Z& e                                mtx[i][j]=0.0;
}
) j8 d* R# [' ?//矩阵相乘
$ O5 E) f1 `% `/ o5 J: R; w8 ]2 mvoid Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{
8 T1 X- M- {  R5 s
        int i,j,k;
        double left[4][4],right[4][4];
/ l! t3 L3 ~. L3 Z' i
        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
2 f, d; w) G: z! E& j                {
                        get_mtx[i][j]=0.0;
! z" F- ?1 {* e5 e8 j                        for(k=0;k<4;k++)
7 w) d% w2 u! g                                get_mtx[i][j]+=left[i][k]*right[k][j];
4 ?- [* `  g9 Y4 @: h5 F7 |# q                }
}
//转置矩阵
' L* w. q/ g) Xvoid Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
  j/ ?) Y% [7 \% b, T        int i,j;
. c; m" A8 y$ J$ C        for(i=0;i<4;i++)
        {
3 r( c' N: n& o2 x/ R                for(j=0;j<4;j++)
                {
                        transpose_mtx[i][j]=mtx[j][i];
2 ~4 @1 w6 W, u. T# e# T                }
        }
% \8 Y/ M4 L  T- {2 D}
0 c! Y, U! Y8 P8 L, r//从11元组获取变换矩阵
9 y# }+ B, Y8 V* i# _3 ]void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
{
, q3 [( x9 U) x- d% Y; G; X
        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
& H7 p3 G) u4 s. y        int i,j;
$ S8 k5 r& V8 w" J% q  S$ S        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
0 g- c# x- o( M  X+ Z9 }                if(i==j)
9 F  M+ Q4 g! f                        pos[i][j]=1.0;
                else
                        pos[i][j]=0.0;
' o& G0 d  G0 d& h! Y: n+ o' C$ d% z        pos[3][0]+=translation[0];
        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
}
7 u0 a' m0 c& |# Y//向量缩放
* |6 T; B3 _+ cvoid Project_Vector_Scale(double a[3],double scale,double b[3])
{
, {) K( k' F+ C1 E' ?% H6 a$ U        b[0]=a[0]*scale;
        b[1]=a[1]*scale;
5 {5 O# s6 k& M        b[2]=a[2]*scale;
}

& ]; |) g7 [- {3 O+ s- B5 Q