Initial commit

Lts/Proxies/Buildings/BuildingControlUnit/VWM/vwm_math.h

@@ -0,0 +1,72 @@
+/**
+  * @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