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

admin

3 ]# [/ @4 A; p& R  M8 U. {
1 |7 @! z1 l0 x( @6 @2 J3 T2 _% s( g
2 P5 T* |) ~% M* h, I# `* c#include <math.h>
5 ~) Y. B# h1 @* j6 ~# u! D//矩阵复制
void Project_Matrix_Copy(double from_mtx[4][4], double to_mtx[4][4])
{
9 ]! V' H  p8 x8 b( J* k" D  o8 r% y        int i,j;
  }$ e# I; J+ `5 `4 C  P
        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        to_mtx[i][j]=from_mtx[i][j];
2 N7 J3 e/ m7 d8 \3 K! t}
+ a6 i4 r! s4 G0 f* S6 l//矩阵初始化
void Project_Matrix_Identity(double mtx[4][4])
/ _! G$ Q9 D4 d& P{
. t) f1 K# E9 Q- f  j0 e        int i,j;
* d: G0 e( ]! E5 D       
8 w; _& _2 U( d4 h3 P' v        for(i=0;i<4;i++)
                for(j=0;j<4;j++)
                        if(i==j)
                                mtx[i][j]=1.0;
+ d. T& y6 p. }7 R- e                        else
                                mtx[i][j]=0.0;
4 W, P- T$ T2 J. k}
9 Q* N+ o& S3 {% m. P% _1 G, I9 H//矩阵相乘
void Project_Matrix_Product(double left_mtx[4][4],double right_mtx[4][4],double get_mtx[4][4])
{
' G, H5 s, \; P$ a2 g
        int i,j,k;
" A2 A- ?) t8 u# D/ V* D/ ]# v0 Y( e        double left[4][4],right[4][4];
4 ?, i# Y- p  r; p2 M
# R) W/ C' |* V+ o5 }4 z        Project_Matrix_Copy(left_mtx,left);
        Project_Matrix_Copy(right_mtx,right);
        for(i=0;i<4;i++)
8 k5 W# Q- M  W/ Q+ h                for(j=0;j<4;j++)
! M  j# D5 r( A7 W                {
                        get_mtx[i][j]=0.0;
' {+ o5 D" q9 {! U. W                        for(k=0;k<4;k++)
4 ~6 d% _  W2 d                                get_mtx[i][j]+=left[i][k]*right[k][j];
                }
}
1 t# ~2 v$ s" m8 U# j  X8 Z//转置矩阵
void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4])
{
        int i,j;
- U2 q4 h5 ^2 P        for(i=0;i<4;i++)
        {
' U3 h" A. @' g2 w                for(j=0;j<4;j++)
0 E' z4 m" t& l& j- s3 K, m& ]                {
- \& u" q2 K) T2 }' u2 J                        transpose_mtx[i][j]=mtx[j][i];
                }
        }
}
- G+ n5 ^. t5 }$ C//从11元组获取变换矩阵
void Project_Matrix_Get_From_Move(double translation[3],double point[3],double rotation[3],double angle,double pos[4][4])
) l+ {4 n; p2 ?: g7 N8 S. g! L{
) |. O3 t. Y1 _6 n2 R# l
% N# P4 A) o, i5 J% v2 z$ O5 _        //Project_Matrix_Get_Rotation(rotation,point,angle,pos);
        int i,j;
        for(i=0;i<4;i++)
        for(j=0;j<4;j++)
                if(i==j)
/ g9 z, f) O; T6 V- A' |% n                        pos[i][j]=1.0;
: o! ^! N* U* v0 o                else
                        pos[i][j]=0.0;
7 w8 D* r% @/ D! @        pos[3][0]+=translation[0];
" s  C" ?8 p0 B# W+ J- P! }! L        pos[3][1]+=translation[1];
        pos[3][2]+=translation[2];
7 `" w8 y2 V. X}
2 o$ M( `, b, M, A//向量缩放
9 G& `/ ]  _% [) ?' X6 X. M6 _7 Jvoid Project_Vector_Scale(double a[3],double scale,double b[3])
% U7 _. H# u' g% W3 j7 V" }{
        b[0]=a[0]*scale;
, a  i9 |/ s6 j. `/ b9 I# y; A        b[1]=a[1]*scale;
6 s3 {# K3 D- \( N7 P4 w% [        b[2]=a[2]*scale;
) n& [$ R1 R' f3 s( J. v' J# E6 ~' g}
- _$ _+ Y+ u) r9 L& g
" E6 P# z6 K# w7 L