spieleprogrammierer.de - Forum und Wiki zur Spieleprogrammierung und Spieleentwicklung

C-/C++-Quelltext

bool StreckenSchneidenSich (const Ogre::Vector3 A, const Ogre::Vector3 B, const Ogre::Vector3 AB, const Ogre::Vector3 C, const Ogre::Vector3 D)
{       
    // verbindungsvektor von C und D
    Ogre::Vector3 CD = D-C;

    // testen ob einer der Graphen parallel zur y achse ist
    bool ABP = B.x-A.x == 0.0 ? true : false;
    bool CDP = D.x-C.x == 0.0 ? true : false;

    // die jeweiligen m Werte ausrechnen
    float ABm = (B.y-A.y) / (B.x-A.x);
    float CDm = (D.y-C.y) / (D.x-C.x);

    float x = 0;
    float y = 0;

    // wenn keiner parallel zur y achse ist
    if(!ABP && !CDP)
    {
        // die jeweiligen b Werte ausrechnen
        float ABb = A.y - ABm*A.x;
        float CDb = C.y - CDm*C.x;

        // Fals sie gleichen steigungswinkel aber andere yachsenabschnitte haben
        if(ABm == CDm && ABb != CDb)
            return false;
        else if (ABm == CDm && ABb == CDb) 
        {
            // Wenn sie gleiche steigungswinkel und gleiche yachsenabschnitte haben
            // Alle punkte testen
            if(((A.z-C.z)/CD.z <= 1.0 && (A.z-C.z)/CD.z >= 0.0 && (A.x-C.x)/CD.x <= 1.0 && (A.x-C.x)/CD.x >= 0.0) || 
               ((B.z-C.z)/CD.z <= 1.0 && (B.z-C.z)/CD.z >= 0.0 && (B.x-C.x)/CD.x <= 1.0 && (B.x-C.x)/CD.x >= 0.0) ||
               ((C.z-A.z)/AB.z <= 1.0 && (C.z-A.z)/AB.z >= 0.0 && (C.x-A.x)/AB.x <= 1.0 && (C.x-A.x)/AB.x >= 0.0) || 
               ((D.z-A.z)/AB.z <= 1.0 && (D.z-A.z)/AB.z >= 0.0 && (D.x-A.x)/AB.x <= 1.0 && (D.x-A.x)/AB.x >= 0.0))
                return true;
            else return false;  
        }
        else
        {
            // wenn Ab parallel is
            if(ABP)
            {
                x = A.x;
                y = ABm*x+ABb;
            }
            else if(CDP) // wenn CD parallel ist
            {
                x = C.x;
                y = CDm*x+CDb;
            }
            else
            {
                // wenn keiner parallel ist, Schnittpunkt berechnen
                x = (CDb-ABb)/(ABb-CDb);
                y = ABm*x + ABb;
            }

            // testen, ob schnittpunkt innerhalb der beiden Strecken liegt.
            if((x-A.x)/AB.x <= 1.0 && (x-C.x)/CD.x <= 1.0 && (x-A.x)/AB.x >= 0.0 && (x-C.x)/CD.x >= 0.0 &&
               (y-A.y)/AB.y <= 1.0 && (y-C.y)/CD.y <= 1.0 && (y-A.y)/AB.y >= 0.0 && (y-C.y)/CD.y >= 0.0)
               return true;
            else
                return false;
        }
    }
    else if(ABP && CDP && C.x != A.x) // wenn beide parallel zur yachse sind, aaber an einer anderen Stelle
        return false;
};