project_matrix.h

基于UG的自动装配技术

void Project_Matrix_Copy(double a[4][4], double b[4][4]);
void Project_Matrix_Product(double aa[4][4],double bb[4][4],double c[4][4]);
void Project_Matrix_Get_From_Move(double translation[3],double point[3],
								  double rotation[3],double angle,double pos[4][4]);

void Project_MatrixGet_Transpose(double mtx[4][4],double transpose_mtx[4][4]);
void Project_Vector_Scale(double a[3],double scale,double b[3]);