TYVisibilityCone.h

Go to the documentation of this file.

/*
 * Copyright (C) <2012-2024> <EDF-DTG> <FRANCE>
 * This file is part of Code_TYMPAN (R).
 * Code_TYMPAN (R) is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 * Code_TYMPAN (R) is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
 * See the GNU General Public License for more details.
 * You should have received a copy of the GNU General Public License along
 * with Code_TYMPAN (R). If not, see <https://www.gnu.org/licenses/>.
 */
 
#ifndef __TY_VISIBILITY_CONE__
#define __TY_VISIBILITY_CONE__
 
#include "Tympan/models/common/3d.h"
#include <gtest/gtest_prod.h>
 
class VisibilityCone
{
 
public:
    VisibilityCone(const OPoint3D& pA, const OPoint3D& pB, const OPoint3D& pC);
 
    bool segmentIsVisibleInCone(const OSegment3D& segmentToTest) const;
 
private:
    void setupNormalsOfCone();
 
    bool pointIsInCone(const OPoint3D& pM2D) const;
 
    bool segmentIntersectsBorderCone(const OPoint3D& pM2D, const OPoint3D& pN2D) const;
 
    OPoint3D _pA2D;
    OPoint3D _pB2D;
    OPoint3D _pC2D;
    OVector3D _vAB;
    OVector3D _vAC;
    OVector3D _nAB;
    OVector3D _nAC;
 
    FRIEND_TEST(test_TYVisibilityCone, pointIsInCone);
    FRIEND_TEST(test_TYVisibilityCone, segmentIntersectsBorderCone);
};
 
inline OVector3D buildVector2D(const OPoint3D& pA2D, const OPoint3D& pB2D)
{
    return OVector3D{pB2D._x - pA2D._x, pB2D._y - pA2D._y, 0.};
}
 
bool segmentIntersectsSemiLine2D(const OVector3D& vAB, const OVector3D& vMN, const OVector3D& vAM);
 
bool solveLin2x2(double a11, double a12, double a21, double a22, double b1, double b2, double& x1,
                 double& x2);
 
#endif // __TY_VISIBILITY_CONE__