Zugegeben, ich glaube nicht, dass jemand viel Lust hat sich den Code, den ich jetzt posten werde komplett durchzulesen. Aber vllt hat ja doch jemand Langeweile oder jemandem fällt die Lösung sofort auf^^
Kurz nochmal zum Problem selbst: Ich benutze einen Gaussalgorithmus, bei dem ich "teilen durch NULL" eigentlich durch vorherige Abfragen vermeide. Er dient der Kollisionsabfrage. Diese funktioniert leider nicht, deshalb hab ich mir die betroffenen Daten im Log ausgeben lassen. Ich weiß nicht wirklich woher die ganzen NANs kommen, da ich weder mit undendlich hantiere, noch negative Zahlen "wurzele". Dass ich "durch Null teilen" versuche zu vermeiden hab ich ja auch schon erwähnt :D
Ich bedanke mich schon einmal im vorraus bei denen, die sich des Problems annehmen werden^^ (sofern es denn welche geben wird^^)
Der Gauss Algorithmus:
Code: Alles auswählen
#include "P12_Math.h"
#include "stdio.h"
void P12G_ChangeLines(int dim,float *mat,int z1,int z2)
{
float *p=new float[dim+1];
for(int i=0;i<dim+1;i++)
{
p[i]=mat[(z1-1)*(dim+1)+i];
mat[(z1-1)*(dim+1)+i]=mat[(z2-1)*(dim+1)+i];
mat[(z2-1)*(dim+1)+i]=p[i];
}
delete[] p;
}
void P12G_AddLineToLine(int dim,float *mat,int Src,int Dst)
{
for(int i=0;i<dim+1;i++)
mat[(Dst-1)*(dim+1)+i]+=mat[(Src-1)*(dim+1)+i];
}
void P12G_MultLine(int dim,float *mat,int z,float value)
{
for(int i=0;i<dim+1;i++)
mat[(z-1)*(dim+1)+i]*=value;
}
bool P12G_IfNull(float x)
{
if(x<0.000001f&&x>-0.000001f)
return true;
else return false;
}
float * P12_GAUSS(int dim,float * mat)
{
//Untere Dreiecksform
for(int i=0;i<dim-1;i++)
{
for(int j=0;j<dim-1-i;j++)
{
if(P12G_IfNull(mat[(dim-j-1)*(dim+1)+i]))
continue;
if(P12G_IfNull(mat[(dim-j-2)*(dim+1)+i]))
{
P12G_ChangeLines(dim,mat,dim-j,dim-j-1);
continue;
}
P12G_MultLine(dim,mat,dim-j,-1/mat[(dim-j-1)*(dim+1)+i]);
P12G_MultLine(dim,mat,dim-j-1,1/mat[(dim-j-2)*(dim+1)+i]);
P12G_AddLineToLine(dim,mat,dim-j-1,dim-j);
}
}
//Obere Dreiecksform
for(int i=0;i<dim-1;i++)
{
if(P12G_IfNull(mat[(dim-i-1)*(dim+1)+dim-i-1]))
return NULL;
P12G_MultLine(dim,mat,dim-i,1/mat[(dim-i-1)*(dim+1)+dim-i-1]);
for(int j=0;j<dim-1-i;j++)
{
if(P12G_IfNull(mat[j*(dim+1)+dim-i-1]))
continue;
P12G_MultLine(dim,mat,j+1,-1/mat[j*(dim+1)+dim-i-1]);
P12G_AddLineToLine(dim,mat,dim-i,j+1);
}
}
//Ergebnis zurückgeben...
if(P12G_IfNull(mat[0]))
return NULL;
P12G_MultLine(dim,mat,1,1/mat[0]);
static float *p=NULL; //Ergebnisarray
if(p) delete[] p; //Speicherlecks bitte erst nach dem Beenden des Programms^^
p=new float[dim];
for(int i=0;i<dim;i++)
p[i]=mat[(i+1)*(dim+1)-1];
return p;
}
Code: Alles auswählen
void * buffer;
objects[i]->getMesh()->getMesh()->LockIndexBuffer(D3DLOCK_READONLY,&buffer);
for(unsigned int j=0;j<objects[i]->getMesh()->getMesh()->GetNumFaces();j++)
{
float mat[12]= { reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3+1].x-reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3].x, reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3+2].x-reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3].x, oldPosX-newPosX, oldPosX-reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3].x,
reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3+1].y-reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3].y, reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3+2].y-reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3].y, oldPosY-newPosY, oldPosY-reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3].y,
reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3+1].z-reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3].z, reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3+2].z-reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3].z, oldPosZ-newPosZ, oldPosZ-reinterpret_cast<D3DXVECTOR3 *>(buffer)[j*3].z
};
if(!P12_GAUSS(3,mat)) continue;
//DEBUGMaßnahme^^
*(iData->getLogFile())<<"\nAusgangspositionen:"<<oldPosX<<"\t"<<oldPosY<<"\t"<<oldPosZ<<"\t"<<newPosX<<"\t"<<newPosY<<"\t"<<newPosZ<<"\n";
for(int i=0;i<12;i++)
{
*(iData->getLogFile())<<"\t"<<mat[i];
}
//Bis hier
if ( mat[3]>=0.0f
&& mat[7]>=0.0f
&& mat[3]+mat[7]<=1.0f
&& mat[11]>=0.0f&&mat[11]<=1.0f
)
{
state=true;
}
}
Code: Alles auswählen
Ausgangspositionen:-3.01092 1.10994 0.224866 -3.001 1.10979 0.226155
1 -0 0 2.87457e-032 -0 1 -0 -6.5157e-016 1.55107e-035 -4.95424e-036 1 7478.59
Ausgangspositionen:-3.01092 1.10994 0.224866 -3.001 1.10979 0.226155
-1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -7.41455e-038 -3.06298e-037 1 303.625
Ausgangspositionen:-3.01092 1.10994 0.224866 -3.001 1.10979 0.226155
-1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN 0 1 0 1.31087e-034 3.00367e-037 2.26223e-037 1 303.625
Ausgangspositionen:-3.001 1.10979 0.226155 -2.99108 1.10964 0.227443
1 -0 0 2.8818e-032 -0 1 -0 -6.53108e-016 1.55481e-035 -4.96621e-036 1 7495.65
Ausgangspositionen:-3.001 1.10979 0.226155 -2.99108 1.10964 0.227443
-1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -7.41455e-038 -3.06298e-037 1 302.625
Ausgangspositionen:-3.001 1.10979 0.226155 -2.99108 1.10964 0.227443
-1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN 0 1 0 1.31087e-034 3.00367e-037 2.26223e-037 1 302.625
Ausgangspositionen:-2.99108 1.10964 0.227443 -2.98117 1.10949 0.228732
1 -0 0 2.87457e-032 -0 1 -0 -6.5157e-016 1.55107e-035 -4.95424e-036 1 7476.59
Ausgangspositionen:-2.99108 1.10964 0.227443 -2.98117 1.10949 0.228732
-1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -7.41455e-038 -3.06298e-037 1 301.625
Ausgangspositionen:-2.99108 1.10964 0.227443 -2.98117 1.10949 0.228732
-1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN 0 1 0 1.31087e-034 3.00367e-037 2.26223e-037 1 301.625
Ausgangspositionen:-2.98117 1.10949 0.228732 -2.97125 1.10935 0.23002
1 -0 0 2.87698e-032 -0 1 -0 -6.52082e-016 1.55231e-035 -4.95822e-036 1 7481.6
Ausgangspositionen:-2.98117 1.10949 0.228732 -2.97125 1.10935 0.23002
-1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN -7.41455e-038 -3.06298e-037 1 300.625
Ausgangspositionen:-2.98117 1.10949 0.228732 -2.97125 1.10935 0.23002
-1.#QNAN -1.#QNAN -1.#QNAN -1.#QNAN 0 1 0 1.31087e-034 3.00367e-037 2.26223e-037 1 300.625