---

2Dlib.cpp

Ir a la documentación de este archivo.

//********   2DLib del Simulador  ***********
#include "2Dlib.h"

matriz IniMatrix (int n)
{
        matriz matrix;
        int i;

        matrix=(double**)malloc(n*sizeof(double*));
        for (i=0;i<n;i++){
                matrix[i]=(double*)calloc(n,sizeof(double));
        }
        return matrix;
}

void FreeMatrix (matriz matrix,int n)
{
        int i;
        for (i=0;i<n;i++) free (matrix[i]);
        free (matrix);
}
        
void mulmat (matriz a, matriz b, matriz c)
{
        int i,j,k;

        for (i=0;i<3;i++){
                for (j=0;j<3;j++){
                        c[i][j]=0.0;
                        for(k=0;k<3;k++){
                                c[i][j]=c[i][j]+(a[i][k]*b[k][j]);
                        }
                }
        }
}

void IniGiro (matriz matrix, double Angulo)
{                                                  
        Angulo=(Angulo*PI)/180;
        matrix[0][0]=matrix[1][1]=cos(Angulo);
        matrix[0][1]=sin(Angulo);
        matrix[1][0]=-sin(Angulo);
        matrix[2][0]=matrix[2][1]=0;
        matrix[2][2]=1;
}

void IniGiroRespectoPunto (matriz matrix, double Angulo, double x,double y)
{
        double AnguloRAD;

        AnguloRAD=(Angulo*PI)/180.0;
        IniGiro(matrix,Angulo);
        matrix[2][0]=-x*(1-cos(AnguloRAD))+y*sin(AnguloRAD);
        matrix[2][1]=y*(1-cos(AnguloRAD))+x*sin(AnguloRAD);
}

void IniTraslacion (matriz matrix, double x, double y)
{
        matrix[0][0]=matrix[1][1]=matrix[2][2]=1;
        matrix[2][0]=long(x);
        matrix[2][1]=long(y);
}

void IniSimetriaX (matriz matrix)
{
        matrix[0][0]=matrix[2][2]=1;
        matrix[1][1]=-1;
}

void IniSimetriaY (matriz matrix)
{
        matrix[1][1]=matrix[2][2]=1;
        matrix[0][0]=-1;
}

void IniEscalado (double EscaladoX,double EscaladoY,matriz matrix)
{
        matrix[0][0]=EscaladoX;
        matrix[1][1]=EscaladoY;
        matrix[2][2]=1;
}

void IniEscaladoRespectoPunto (double EscaladoX,double EscaladoY,
                                                           double X,double Y,matriz matrix)
{
        IniEscalado (EscaladoX,EscaladoY,matrix);
        matrix[2][0]=X*(1-EscaladoX);
        matrix[2][1]=-Y*(1+EscaladoY);
}

Pt2D MultVect (matriz matrix, Pt2D punto)
{
        Pt2D p;

        p.x=int((punto.x*matrix[0][0])+(punto.y*matrix[1][0])+(matrix[2][0]));
        p.y=int((punto.x*matrix[0][1])+(punto.y*matrix[1][1])+(matrix[2][1]));
        return p;
}

matriz Inversa3X3 (matriz matrix)
{
        double tmp;
        matriz resultado;

        resultado=IniMatrix(3);

        tmp=+(matrix[0][0]*matrix[1][1]*matrix[2][2])+(matrix[1][0]*matrix[0][2]*matrix[2][1])+(matrix[2][0]*matrix[0][1]*matrix[1][2])
                -(matrix[0][0]*matrix[1][2]*matrix[2][1])-(matrix[1][0]*matrix[0][1]*matrix[2][2])-(matrix[2][0]*matrix[0][2]*matrix[1][1]);

        resultado[0][0]=((matrix[1][1]*matrix[2][2])-(matrix[1][2]*matrix[2][1]))/tmp;
        resultado[0][1]=-(((matrix[0][1]*matrix[2][2])-(matrix[0][2]*matrix[2][1]))/tmp);
        resultado[0][2]=((matrix[0][1]*matrix[1][2])-(matrix[0][2]*matrix[1][1]))/tmp;
        resultado[1][0]=-(((matrix[1][0]*matrix[2][2])-(matrix[1][2]*matrix[2][0]))/tmp);               
        resultado[1][1]=((matrix[0][0]*matrix[2][2])-(matrix[0][2]*matrix[2][0]))/tmp;
        resultado[1][2]=-(((matrix[0][0]*matrix[1][2])-(matrix[0][2]*matrix[1][0]))/tmp);               
        resultado[2][0]=((matrix[1][0]*matrix[2][1])-(matrix[1][1]*matrix[2][0]))/tmp;
        resultado[2][1]=-(((matrix[0][0]*matrix[2][1])-(matrix[0][1]*matrix[2][0]))/tmp);
        resultado[2][2]=((matrix[0][0]*matrix[1][1])-(matrix[0][1]*matrix[1][0]))/tmp;
        return resultado;
}

---