/**
  * @RDE_HEADER@
  * Math claculations for VWM
  * $Id$
  * $HeadURL$
  * $Author$
  * Created by Christian Ehrlicher, SLSE, 2017-01-24
  */
#pragma once

#include <LtsUtilsCore/qpoint3d.h>
#include <QVector>
#include "vwm_building.h"
#include "vwm_types.h"
#include <VWM/buildingcontrolvwm_export.h>

namespace BuildingControlUnit
{
namespace VWM
{
namespace Math
{
class BUILDINGCONTROLVWM_EXPORT VwmPlane
{
public:
  VwmPlane(const LtsUtils::QPoint3D &pos, const LtsUtils::QPoint3D &vec1, const LtsUtils::QPoint3D &vec2);

  bool getPlaneEquation() const;
  bool isPlaneLineIntersection(const LtsUtils::QPoint3D &vec) const;
  bool isPlaneLineOrthogonal(const LtsUtils::QPoint3D &dir) const;
  double getPlaneLineSkalar(const LtsUtils::QPoint3D &pos, const LtsUtils::QPoint3D &dir) const;
  LtsUtils::QPoint3D getPlaneLineIntersection(const LtsUtils::QPoint3D &pos, const LtsUtils::QPoint3D &dir) const;
  double distPlaneToPoint(const LtsUtils::QPoint3D &pos, const LtsUtils::QPoint3D &dir) const;

  const LtsUtils::QPoint3D &pos() const { return m_pos; }
  const LtsUtils::QPoint3D &vec1() const { return m_vec1; }
  const LtsUtils::QPoint3D &vec2() const { return m_vec2; }
  const LtsUtils::QPoint3D &det() const { return m_det; }
  double planeC() const { return m_planeC; }

  bool isVertical() const { return qFuzzyIsNull(LtsUtils::QPoint3D::dotProduct({0., 0., 1.}, LtsUtils::QPoint3D::crossProduct(m_vec1, m_vec2))); }

private:
  LtsUtils::QPoint3D m_pos;
  LtsUtils::QPoint3D m_vec1;
  LtsUtils::QPoint3D m_vec2;
  LtsUtils::QPoint3D m_det;
  double m_planeC{0.0};
};

BUILDINGCONTROLVWM_EXPORT LtsUtils::QPoint3D invalidPosition();
BUILDINGCONTROLVWM_EXPORT LtsUtils::QPoint3D rotateAroundYAxis(const LtsUtils::QPoint3D &in, double phi);
BUILDINGCONTROLVWM_EXPORT LtsUtils::QPoint3D rotateAroundZAxis(const LtsUtils::QPoint3D &in, double phi);
BUILDINGCONTROLVWM_EXPORT HitPosition getHitPosition(const LtsUtils::QPoint3D &position, const LtsUtils::QPoint3D &direction, const QMap<int, Room> &rooms);
BUILDINGCONTROLVWM_EXPORT HitPosition checkBsmPosition(const LtsUtils::QPoint3D &position, const LtsUtils::QPoint3D &bsmViewDirection, const QMap<int, Room> &rooms);
BUILDINGCONTROLVWM_EXPORT bool isPointInPolygon(const QVector<LtsUtils::QPoint3D> &poly, const LtsUtils::QPoint3D &pos);  // for test purposes
BUILDINGCONTROLVWM_EXPORT LtsUtils::QPoint3D intersection(const LtsUtils::QPoint3D &start, const LtsUtils::QPoint3D &end, const QMap<int, Room> &rooms);
BUILDINGCONTROLVWM_EXPORT bool hasIntersection(const LtsUtils::QPoint3D &start, const LtsUtils::QPoint3D &end, const QMap<int, Room> &rooms);

BUILDINGCONTROLVWM_EXPORT bool vecIsLinearlyDependent(const LtsUtils::QPoint3D &v1, const LtsUtils::QPoint3D &v2);

/**
 * @brief getCoordsForPlane will check for lineareyDependencies and remove that values.
 * @param poly input polygon, most likly take from xml files of a building
 * @return reduced polygon
 */
BUILDINGCONTROLVWM_EXPORT QVector<LtsUtils::QPoint3D> getCoordsForPlane(const QVector<LtsUtils::QPoint3D> &poly);


} // namespace Math
} // namespace VWM
} // namespace BuildingControlUnit