spieleprogrammierer.de - Forum und Wiki zur Spieleprogrammierung und Spieleentwicklung

C-/C++-Quelltext

bool CollisionLine_Line(LINE line1, LINE line2, VECTOR_XYZ *sp)
{
    VECTOR_XY KollPoint;
    bool KoolX =false;
    bool KoolY=false;
    float s, t;
    // test für 2D ablauf -> 3D-Vektoren in 2D umwandeln

    VECTOR_XY A, B, C, D;
    make2Dvector(A, line1.v1);
    make2Dvector(B, line1.v2);
    make2Dvector(C, line2.v1);
    make2Dvector(D, line2.v2);
    // werte wurden in 2d-vektoren umgewandelt


    s=((A.y-C.y)*(D.x-C.x)-(A.x-C.x)*(D.y-C.y))/((B.x-A.x)*(D.y-C.y)-(B.y-A.y)*(D.x-C.x));
    t=((A.y-C.y)*(B.x-A.x)-(A.x-C.x)*(B.y-A.y))/((B.x-A.x)*(D.y-C.y)-(B.y-A.y)*(D.x-C.x));

    if(((B.x-A.x)*(D.y-C.y)-(B.y-A.y)*(D.x-C.x))==0)
        printf("geraden sind parallel\n");
    if(((A.y-C.y)*(D.x-C.x)-(A.x-C.x)*(D.y-C.y))==0)
        printf("geraden sind kollinear\n");
    if(0<=s && s<=1 && 0<=t && t<=1)
    {
        KollPoint=A+s*(B-A);
        if(B.x>=KollPoint.x && A.x<=KollPoint.x)
            KoolX=true;
        else
            return false;
        if(C.y>D.y)
        {
            if((B.y<=C.y || A.y<=C.y) && 
               (B.y>=D.y || A.y>=D.y))
                KoolY=true;
            else
                return false;
        }
        else
        {
            if((B.y<=D.y || A.y<=D.y) &&
               (B.y>=C.y || A.y>=C.y))
               KoolY=true;
            else
                return false;
        }
        if(KoolX==true && KoolY==true)
        {
            *sp=CreateVector(KollPoint.x, KollPoint.y, line1.v1.z);
            return true;
        }
    }
    return false;
}