diff options
Diffstat (limited to 'src/gui/math3d/qvectornd.h')
| -rw-r--r-- | src/gui/math3d/qvectornd.h | 1086 |
1 files changed, 1086 insertions, 0 deletions
diff --git a/src/gui/math3d/qvectornd.h b/src/gui/math3d/qvectornd.h new file mode 100644 index 0000000000..a8adf12801 --- /dev/null +++ b/src/gui/math3d/qvectornd.h @@ -0,0 +1,1086 @@ +// Copyright (C) 2020 The Qt Company Ltd. +// Copyright (C) 2020 Klarälvdalens Datakonsult AB, a KDAB Group company, info@kdab.com, author Giuseppe D'Angelo <giuseppe.dangelo@kdab.com> +// SPDX-License-Identifier: LicenseRef-Qt-Commercial OR LGPL-3.0-only OR GPL-2.0-only OR GPL-3.0-only + +#ifndef QVECTORND_H +#define QVECTORND_H + +#include <QtGui/qtguiglobal.h> +#include <QtCore/qpoint.h> +#include <QtCore/qrect.h> +#include <QtCore/qmath.h> + +#include <QtCore/q20type_traits.h> +#include <QtCore/q23utility.h> + +QT_BEGIN_NAMESPACE + +// QT_ENABLE_P0846_SEMANTICS_FOR(get) // from qpoint.h + +class QVector2D; +class QVector3D; +class QVector4D; +class QMatrix4x4; +class QVariant; + +/***************************** QVector2D *****************************/ + +#ifndef QT_NO_VECTOR2D + +class QVector2D +{ +public: + constexpr QVector2D() noexcept; + explicit QVector2D(Qt::Initialization) noexcept {} + constexpr QVector2D(float xpos, float ypos) noexcept; + constexpr explicit QVector2D(QPoint point) noexcept; + constexpr explicit QVector2D(QPointF point) noexcept; +#ifndef QT_NO_VECTOR3D + constexpr explicit QVector2D(QVector3D vector) noexcept; +#endif +#ifndef QT_NO_VECTOR4D + constexpr explicit QVector2D(QVector4D vector) noexcept; +#endif + + constexpr bool isNull() const noexcept; + + constexpr float x() const noexcept; + constexpr float y() const noexcept; + + constexpr void setX(float x) noexcept; + constexpr void setY(float y) noexcept; + + constexpr float &operator[](int i); + constexpr float operator[](int i) const; + + [[nodiscard]] float length() const noexcept; + [[nodiscard]] constexpr float lengthSquared() const noexcept; + + [[nodiscard]] QVector2D normalized() const noexcept; + void normalize() noexcept; + + [[nodiscard]] float distanceToPoint(QVector2D point) const noexcept; + [[nodiscard]] float distanceToLine(QVector2D point, QVector2D direction) const noexcept; + + constexpr QVector2D &operator+=(QVector2D vector) noexcept; + constexpr QVector2D &operator-=(QVector2D vector) noexcept; + constexpr QVector2D &operator*=(float factor) noexcept; + constexpr QVector2D &operator*=(QVector2D vector) noexcept; + constexpr QVector2D &operator/=(float divisor); + constexpr QVector2D &operator/=(QVector2D vector); + + [[nodiscard]] static constexpr float dotProduct(QVector2D v1, QVector2D v2) noexcept; + +QT_WARNING_PUSH +QT_WARNING_DISABLE_FLOAT_COMPARE + constexpr friend inline bool operator==(QVector2D v1, QVector2D v2) noexcept + { + return v1.v[0] == v2.v[0] && v1.v[1] == v2.v[1]; + } + + constexpr friend inline bool operator!=(QVector2D v1, QVector2D v2) noexcept + { + return v1.v[0] != v2.v[0] || v1.v[1] != v2.v[1]; + } +QT_WARNING_POP + + constexpr friend inline QVector2D operator+(QVector2D v1, QVector2D v2) noexcept + { + return QVector2D(v1.v[0] + v2.v[0], v1.v[1] + v2.v[1]); + } + + constexpr friend inline QVector2D operator-(QVector2D v1, QVector2D v2) noexcept + { + return QVector2D(v1.v[0] - v2.v[0], v1.v[1] - v2.v[1]); + } + + constexpr friend inline QVector2D operator*(float factor, QVector2D vector) noexcept + { + return QVector2D(vector.v[0] * factor, vector.v[1] * factor); + } + + constexpr friend inline QVector2D operator*(QVector2D vector, float factor) noexcept + { + return QVector2D(vector.v[0] * factor, vector.v[1] * factor); + } + + constexpr friend inline QVector2D operator*(QVector2D v1, QVector2D v2) noexcept + { + return QVector2D(v1.v[0] * v2.v[0], v1.v[1] * v2.v[1]); + } + + constexpr friend inline QVector2D operator-(QVector2D vector) noexcept + { + return QVector2D(-vector.v[0], -vector.v[1]); + } + + constexpr friend inline QVector2D operator/(QVector2D vector, float divisor) + { + Q_ASSERT(divisor < 0 || divisor > 0); + return QVector2D(vector.v[0] / divisor, vector.v[1] / divisor); + } + + constexpr friend inline QVector2D operator/(QVector2D vector, QVector2D divisor) + { + Q_ASSERT(divisor.v[0] < 0 || divisor.v[0] > 0); + Q_ASSERT(divisor.v[1] < 0 || divisor.v[1] > 0); + return QVector2D(vector.v[0] / divisor.v[0], vector.v[1] / divisor.v[1]); + } + + friend Q_GUI_EXPORT bool qFuzzyCompare(QVector2D v1, QVector2D v2) noexcept; + +#ifndef QT_NO_VECTOR3D + constexpr QVector3D toVector3D() const noexcept; +#endif +#ifndef QT_NO_VECTOR4D + constexpr QVector4D toVector4D() const noexcept; +#endif + + constexpr QPoint toPoint() const noexcept; + constexpr QPointF toPointF() const noexcept; + + Q_GUI_EXPORT operator QVariant() const; + +private: + float v[2]; + + friend class QVector3D; + friend class QVector4D; + + template <std::size_t I, + typename V, + std::enable_if_t<(I < 2), bool> = true, + std::enable_if_t<std::is_same_v<q20::remove_cvref_t<V>, QVector2D>, bool> = true> + friend constexpr decltype(auto) get(V &&vec) noexcept + { + return q23::forward_like<V>(vec.v[I]); + } +}; + +Q_DECLARE_TYPEINFO(QVector2D, Q_PRIMITIVE_TYPE); + +#endif // QT_NO_VECTOR2D + + + +/***************************** QVector3D *****************************/ + +#ifndef QT_NO_VECTOR3D + +class QVector3D +{ +public: + constexpr QVector3D() noexcept; + explicit QVector3D(Qt::Initialization) noexcept {} + constexpr QVector3D(float xpos, float ypos, float zpos) noexcept : v{xpos, ypos, zpos} {} + + constexpr explicit QVector3D(QPoint point) noexcept; + constexpr explicit QVector3D(QPointF point) noexcept; +#ifndef QT_NO_VECTOR2D + constexpr explicit QVector3D(QVector2D vector) noexcept; + constexpr QVector3D(QVector2D vector, float zpos) noexcept; +#endif +#ifndef QT_NO_VECTOR4D + constexpr explicit QVector3D(QVector4D vector) noexcept; +#endif + + constexpr bool isNull() const noexcept; + + constexpr float x() const noexcept; + constexpr float y() const noexcept; + constexpr float z() const noexcept; + + constexpr void setX(float x) noexcept; + constexpr void setY(float y) noexcept; + constexpr void setZ(float z) noexcept; + + constexpr float &operator[](int i); + constexpr float operator[](int i) const; + + [[nodiscard]] float length() const noexcept; + [[nodiscard]] constexpr float lengthSquared() const noexcept; + + [[nodiscard]] QVector3D normalized() const noexcept; + void normalize() noexcept; + + constexpr QVector3D &operator+=(QVector3D vector) noexcept; + constexpr QVector3D &operator-=(QVector3D vector) noexcept; + constexpr QVector3D &operator*=(float factor) noexcept; + constexpr QVector3D &operator*=(QVector3D vector) noexcept; + constexpr QVector3D &operator/=(float divisor); + constexpr QVector3D &operator/=(QVector3D vector); + + [[nodiscard]] static constexpr float dotProduct(QVector3D v1, QVector3D v2) noexcept; + [[nodiscard]] static constexpr QVector3D crossProduct(QVector3D v1, QVector3D v2) noexcept; + + [[nodiscard]] static QVector3D normal(QVector3D v1, QVector3D v2) noexcept; + [[nodiscard]] static QVector3D normal(QVector3D v1, QVector3D v2, QVector3D v3) noexcept; + + Q_GUI_EXPORT QVector3D project(const QMatrix4x4 &modelView, const QMatrix4x4 &projection, const QRect &viewport) const; + Q_GUI_EXPORT QVector3D unproject(const QMatrix4x4 &modelView, const QMatrix4x4 &projection, const QRect &viewport) const; + +QT_WARNING_PUSH +QT_WARNING_DISABLE_FLOAT_COMPARE + constexpr friend inline bool operator==(QVector3D v1, QVector3D v2) noexcept + { + return v1.v[0] == v2.v[0] && v1.v[1] == v2.v[1] && v1.v[2] == v2.v[2]; + } + + constexpr friend inline bool operator!=(QVector3D v1, QVector3D v2) noexcept + { + return v1.v[0] != v2.v[0] || v1.v[1] != v2.v[1] || v1.v[2] != v2.v[2]; + } +QT_WARNING_POP + float distanceToPoint(QVector3D point) const noexcept; + constexpr float distanceToPlane(QVector3D plane, QVector3D normal) const noexcept; + float distanceToPlane(QVector3D plane1, QVector3D plane2, QVector3D plane3) const noexcept; + float distanceToLine(QVector3D point, QVector3D direction) const noexcept; + + + constexpr friend inline QVector3D operator+(QVector3D v1, QVector3D v2) noexcept + { + return QVector3D(v1.v[0] + v2.v[0], v1.v[1] + v2.v[1], v1.v[2] + v2.v[2]); + } + + constexpr friend inline QVector3D operator-(QVector3D v1, QVector3D v2) noexcept + { + return QVector3D(v1.v[0] - v2.v[0], v1.v[1] - v2.v[1], v1.v[2] - v2.v[2]); + } + + constexpr friend inline QVector3D operator*(float factor, QVector3D vector) noexcept + { + return QVector3D(vector.v[0] * factor, vector.v[1] * factor, vector.v[2] * factor); + } + + constexpr friend inline QVector3D operator*(QVector3D vector, float factor) noexcept + { + return QVector3D(vector.v[0] * factor, vector.v[1] * factor, vector.v[2] * factor); + } + + constexpr friend inline QVector3D operator*(QVector3D v1, QVector3D v2) noexcept + { + return QVector3D(v1.v[0] * v2.v[0], v1.v[1] * v2.v[1], v1.v[2] * v2.v[2]); + } + + constexpr friend inline QVector3D operator-(QVector3D vector) noexcept + { + return QVector3D(-vector.v[0], -vector.v[1], -vector.v[2]); + } + + constexpr friend inline QVector3D operator/(QVector3D vector, float divisor) + { + Q_ASSERT(divisor < 0 || divisor > 0); + return QVector3D(vector.v[0] / divisor, vector.v[1] / divisor, vector.v[2] / divisor); + } + + constexpr friend inline QVector3D operator/(QVector3D vector, QVector3D divisor) + { + Q_ASSERT(divisor.v[0] > 0 || divisor.v[0] < 0); + Q_ASSERT(divisor.v[1] > 0 || divisor.v[1] < 0); + Q_ASSERT(divisor.v[2] > 0 || divisor.v[2] < 0); + return QVector3D(vector.v[0] / divisor.v[0], vector.v[1] / divisor.v[1], + vector.v[2] / divisor.v[2]); + } + + friend Q_GUI_EXPORT bool qFuzzyCompare(QVector3D v1, QVector3D v2) noexcept; + +#ifndef QT_NO_VECTOR2D + constexpr QVector2D toVector2D() const noexcept; +#endif +#ifndef QT_NO_VECTOR4D + constexpr QVector4D toVector4D() const noexcept; +#endif + + constexpr QPoint toPoint() const noexcept; + constexpr QPointF toPointF() const noexcept; + + Q_GUI_EXPORT operator QVariant() const; + +private: + float v[3]; + + friend class QVector2D; + friend class QVector4D; +#ifndef QT_NO_MATRIX4X4 + friend QVector3D operator*(const QVector3D& vector, const QMatrix4x4& matrix); + friend QVector3D operator*(const QMatrix4x4& matrix, const QVector3D& vector); +#endif + + template <std::size_t I, + typename V, + std::enable_if_t<(I < 3), bool> = true, + std::enable_if_t<std::is_same_v<q20::remove_cvref_t<V>, QVector3D>, bool> = true> + friend constexpr decltype(auto) get(V &&vec) noexcept + { + return q23::forward_like<V>(vec.v[I]); + } +}; + +Q_DECLARE_TYPEINFO(QVector3D, Q_PRIMITIVE_TYPE); + +#endif // QT_NO_VECTOR3D + + + +/***************************** QVector4D *****************************/ + +#ifndef QT_NO_VECTOR4D + +class QVector4D +{ +public: + constexpr QVector4D() noexcept; + explicit QVector4D(Qt::Initialization) noexcept {} + constexpr QVector4D(float xpos, float ypos, float zpos, float wpos) noexcept; + constexpr explicit QVector4D(QPoint point) noexcept; + constexpr explicit QVector4D(QPointF point) noexcept; +#ifndef QT_NO_VECTOR2D + constexpr explicit QVector4D(QVector2D vector) noexcept; + constexpr QVector4D(QVector2D vector, float zpos, float wpos) noexcept; +#endif +#ifndef QT_NO_VECTOR3D + constexpr explicit QVector4D(QVector3D vector) noexcept; + constexpr QVector4D(QVector3D vector, float wpos) noexcept; +#endif + + constexpr bool isNull() const noexcept; + + constexpr float x() const noexcept; + constexpr float y() const noexcept; + constexpr float z() const noexcept; + constexpr float w() const noexcept; + + constexpr void setX(float x) noexcept; + constexpr void setY(float y) noexcept; + constexpr void setZ(float z) noexcept; + constexpr void setW(float w) noexcept; + + constexpr float &operator[](int i); + constexpr float operator[](int i) const; + + [[nodiscard]] float length() const noexcept; + [[nodiscard]] constexpr float lengthSquared() const noexcept; + + [[nodiscard]] QVector4D normalized() const noexcept; + void normalize() noexcept; + + constexpr QVector4D &operator+=(QVector4D vector) noexcept; + constexpr QVector4D &operator-=(QVector4D vector) noexcept; + constexpr QVector4D &operator*=(float factor) noexcept; + constexpr QVector4D &operator*=(QVector4D vector) noexcept; + constexpr QVector4D &operator/=(float divisor); + constexpr inline QVector4D &operator/=(QVector4D vector); + + [[nodiscard]] static constexpr float dotProduct(QVector4D v1, QVector4D v2) noexcept; + +QT_WARNING_PUSH +QT_WARNING_DISABLE_FLOAT_COMPARE + constexpr friend inline bool operator==(QVector4D v1, QVector4D v2) noexcept + { + return v1.v[0] == v2.v[0] && v1.v[1] == v2.v[1] && v1.v[2] == v2.v[2] && v1.v[3] == v2.v[3]; + } + + constexpr friend inline bool operator!=(QVector4D v1, QVector4D v2) noexcept + { + return v1.v[0] != v2.v[0] || v1.v[1] != v2.v[1] || v1.v[2] != v2.v[2] || v1.v[3] != v2.v[3]; + } +QT_WARNING_POP + constexpr friend inline QVector4D operator+(QVector4D v1, QVector4D v2) noexcept + { + return QVector4D(v1.v[0] + v2.v[0], v1.v[1] + v2.v[1], v1.v[2] + v2.v[2], v1.v[3] + v2.v[3]); + } + + constexpr friend inline QVector4D operator-(QVector4D v1, QVector4D v2) noexcept + { + return QVector4D(v1.v[0] - v2.v[0], v1.v[1] - v2.v[1], v1.v[2] - v2.v[2], v1.v[3] - v2.v[3]); + } + + constexpr friend inline QVector4D operator*(float factor, QVector4D vector) noexcept + { + return QVector4D(vector.v[0] * factor, vector.v[1] * factor, vector.v[2] * factor, vector.v[3] * factor); + } + + constexpr friend inline QVector4D operator*(QVector4D vector, float factor) noexcept + { + return QVector4D(vector.v[0] * factor, vector.v[1] * factor, vector.v[2] * factor, vector.v[3] * factor); + } + + constexpr friend inline QVector4D operator*(QVector4D v1, QVector4D v2) noexcept + { + return QVector4D(v1.v[0] * v2.v[0], v1.v[1] * v2.v[1], v1.v[2] * v2.v[2], v1.v[3] * v2.v[3]); + } + + constexpr friend inline QVector4D operator-(QVector4D vector) noexcept + { + return QVector4D(-vector.v[0], -vector.v[1], -vector.v[2], -vector.v[3]); + } + + constexpr friend inline QVector4D operator/(QVector4D vector, float divisor) + { + Q_ASSERT(divisor < 0 || divisor > 0); + return QVector4D(vector.v[0] / divisor, vector.v[1] / divisor, vector.v[2] / divisor, vector.v[3] / divisor); + } + + constexpr friend inline QVector4D operator/(QVector4D vector, QVector4D divisor) + { + Q_ASSERT(divisor.v[0] > 0 || divisor.v[0] < 0); + Q_ASSERT(divisor.v[1] > 0 || divisor.v[1] < 0); + Q_ASSERT(divisor.v[2] > 0 || divisor.v[2] < 0); + Q_ASSERT(divisor.v[3] > 0 || divisor.v[3] < 0); + return QVector4D(vector.v[0] / divisor.v[0], vector.v[1] / divisor.v[1], + vector.v[2] / divisor.v[2], vector.v[3] / divisor.v[3]); + } + + friend Q_GUI_EXPORT bool qFuzzyCompare(QVector4D v1, QVector4D v2) noexcept; + +#ifndef QT_NO_VECTOR2D + constexpr QVector2D toVector2D() const noexcept; + constexpr QVector2D toVector2DAffine() const noexcept; +#endif +#ifndef QT_NO_VECTOR3D + constexpr QVector3D toVector3D() const noexcept; + constexpr QVector3D toVector3DAffine() const noexcept; +#endif + + constexpr QPoint toPoint() const noexcept; + constexpr QPointF toPointF() const noexcept; + + Q_GUI_EXPORT operator QVariant() const; + +private: + float v[4]; + + friend class QVector2D; + friend class QVector3D; + friend class QMatrix4x4; +#ifndef QT_NO_MATRIX4X4 + friend QVector4D operator*(const QVector4D& vector, const QMatrix4x4& matrix); + friend QVector4D operator*(const QMatrix4x4& matrix, const QVector4D& vector); +#endif + + template <std::size_t I, + typename V, + std::enable_if_t<(I < 4), bool> = true, + std::enable_if_t<std::is_same_v<q20::remove_cvref_t<V>, QVector4D>, bool> = true> + friend constexpr decltype(auto) get(V &&vec) noexcept + { + return q23::forward_like<V>(vec.v[I]); + } +}; + +Q_DECLARE_TYPEINFO(QVector4D, Q_PRIMITIVE_TYPE); + +#endif // QT_NO_VECTOR4D + + + +/***************************** QVector2D *****************************/ + +#ifndef QT_NO_VECTOR2D + +constexpr inline QVector2D::QVector2D() noexcept : v{0.0f, 0.0f} {} + +constexpr inline QVector2D::QVector2D(float xpos, float ypos) noexcept : v{xpos, ypos} {} + +constexpr inline QVector2D::QVector2D(QPoint point) noexcept : v{float(point.x()), float(point.y())} {} + +constexpr inline QVector2D::QVector2D(QPointF point) noexcept : v{float(point.x()), float(point.y())} {} + +#ifndef QT_NO_VECTOR3D +constexpr inline QVector2D::QVector2D(QVector3D vector) noexcept : v{vector[0], vector[1]} {} +#endif +#ifndef QT_NO_VECTOR4D +constexpr inline QVector2D::QVector2D(QVector4D vector) noexcept : v{vector[0], vector[1]} {} +#endif + +constexpr inline bool QVector2D::isNull() const noexcept +{ + return qIsNull(v[0]) && qIsNull(v[1]); +} + +constexpr inline float QVector2D::x() const noexcept { return v[0]; } +constexpr inline float QVector2D::y() const noexcept { return v[1]; } + +constexpr inline void QVector2D::setX(float aX) noexcept { v[0] = aX; } +constexpr inline void QVector2D::setY(float aY) noexcept { v[1] = aY; } + +constexpr inline float &QVector2D::operator[](int i) +{ + Q_ASSERT(uint(i) < 2u); + return v[i]; +} + +constexpr inline float QVector2D::operator[](int i) const +{ + Q_ASSERT(uint(i) < 2u); + return v[i]; +} + +inline float QVector2D::length() const noexcept +{ + return qHypot(v[0], v[1]); +} + +constexpr inline float QVector2D::lengthSquared() const noexcept +{ + return v[0] * v[0] + v[1] * v[1]; +} + +inline QVector2D QVector2D::normalized() const noexcept +{ + const float len = length(); + return qFuzzyIsNull(len - 1.0f) ? *this : qFuzzyIsNull(len) ? QVector2D() + : QVector2D(v[0] / len, v[1] / len); +} + +inline void QVector2D::normalize() noexcept +{ + const float len = length(); + if (qFuzzyIsNull(len - 1.0f) || qFuzzyIsNull(len)) + return; + + v[0] /= len; + v[1] /= len; +} + +inline float QVector2D::distanceToPoint(QVector2D point) const noexcept +{ + return (*this - point).length(); +} + +inline float QVector2D::distanceToLine(QVector2D point, QVector2D direction) const noexcept +{ + if (direction.isNull()) + return (*this - point).length(); + QVector2D p = point + dotProduct(*this - point, direction) * direction; + return (*this - p).length(); +} + +constexpr inline QVector2D &QVector2D::operator+=(QVector2D vector) noexcept +{ + v[0] += vector.v[0]; + v[1] += vector.v[1]; + return *this; +} + +constexpr inline QVector2D &QVector2D::operator-=(QVector2D vector) noexcept +{ + v[0] -= vector.v[0]; + v[1] -= vector.v[1]; + return *this; +} + +constexpr inline QVector2D &QVector2D::operator*=(float factor) noexcept +{ + v[0] *= factor; + v[1] *= factor; + return *this; +} + +constexpr inline QVector2D &QVector2D::operator*=(QVector2D vector) noexcept +{ + v[0] *= vector.v[0]; + v[1] *= vector.v[1]; + return *this; +} + +constexpr inline QVector2D &QVector2D::operator/=(float divisor) +{ + Q_ASSERT(divisor < 0 || divisor > 0); + v[0] /= divisor; + v[1] /= divisor; + return *this; +} + +constexpr inline QVector2D &QVector2D::operator/=(QVector2D vector) +{ + Q_ASSERT(vector.v[0] > 0 || vector.v[0] < 0); + Q_ASSERT(vector.v[1] > 0 || vector.v[1] < 0); + v[0] /= vector.v[0]; + v[1] /= vector.v[1]; + return *this; +} + +constexpr inline float QVector2D::dotProduct(QVector2D v1, QVector2D v2) noexcept +{ + return v1.v[0] * v2.v[0] + v1.v[1] * v2.v[1]; +} + +#ifndef QT_NO_VECTOR3D +constexpr inline QVector3D QVector2D::toVector3D() const noexcept +{ + return QVector3D(v[0], v[1], 0.0f); +} +#endif +#ifndef QT_NO_VECTOR4D +constexpr inline QVector4D QVector2D::toVector4D() const noexcept +{ + return QVector4D(v[0], v[1], 0.0f, 0.0f); +} +#endif + + +constexpr inline QPoint QVector2D::toPoint() const noexcept +{ + return QPoint(qRound(v[0]), qRound(v[1])); +} + +constexpr inline QPointF QVector2D::toPointF() const noexcept +{ + return QPointF(qreal(v[0]), qreal(v[1])); +} + +#ifndef QT_NO_DEBUG_STREAM +Q_GUI_EXPORT QDebug operator<<(QDebug dbg, QVector2D vector); +#endif + +#ifndef QT_NO_DATASTREAM +Q_GUI_EXPORT QDataStream &operator<<(QDataStream &, QVector2D ); +Q_GUI_EXPORT QDataStream &operator>>(QDataStream &, QVector2D &); +#endif + +#endif // QT_NO_VECTOR2D + + + +/***************************** QVector3D *****************************/ + +#ifndef QT_NO_VECTOR3D + +constexpr inline QVector3D::QVector3D() noexcept : v{0.0f, 0.0f, 0.0f} {} + +constexpr inline QVector3D::QVector3D(QPoint point) noexcept : v{float(point.x()), float(point.y()), 0.0f} {} + +constexpr inline QVector3D::QVector3D(QPointF point) noexcept : v{float(point.x()), float(point.y()), 0.0f} {} + +#ifndef QT_NO_VECTOR2D +constexpr inline QVector3D::QVector3D(QVector2D vector) noexcept : v{vector[0], vector[1], 0.0f} {} +constexpr inline QVector3D::QVector3D(QVector2D vector, float zpos) noexcept : v{vector[0], vector[1], zpos} {} +#endif + +#ifndef QT_NO_VECTOR4D +constexpr inline QVector3D::QVector3D(QVector4D vector) noexcept : v{vector[0], vector[1], vector[2]} {} +#endif + +constexpr inline bool QVector3D::isNull() const noexcept +{ + return qIsNull(v[0]) && qIsNull(v[1]) && qIsNull(v[2]); +} + +constexpr inline float QVector3D::x() const noexcept { return v[0]; } +constexpr inline float QVector3D::y() const noexcept { return v[1]; } +constexpr inline float QVector3D::z() const noexcept { return v[2]; } + +constexpr inline void QVector3D::setX(float aX) noexcept { v[0] = aX; } +constexpr inline void QVector3D::setY(float aY) noexcept { v[1] = aY; } +constexpr inline void QVector3D::setZ(float aZ) noexcept { v[2] = aZ; } + +constexpr inline float &QVector3D::operator[](int i) +{ + Q_ASSERT(uint(i) < 3u); + return v[i]; +} + +constexpr inline float QVector3D::operator[](int i) const +{ + Q_ASSERT(uint(i) < 3u); + return v[i]; +} + +inline float QVector3D::length() const noexcept +{ + return qHypot(v[0], v[1], v[2]); +} + +inline QVector3D QVector3D::normalized() const noexcept +{ + const float len = length(); + return qFuzzyIsNull(len - 1.0f) ? *this : qFuzzyIsNull(len) ? QVector3D() + : QVector3D(v[0] / len, v[1] / len, v[2] / len); +} + +inline void QVector3D::normalize() noexcept +{ + const float len = length(); + if (qFuzzyIsNull(len - 1.0f) || qFuzzyIsNull(len)) + return; + + v[0] /= len; + v[1] /= len; + v[2] /= len; +} + +constexpr inline float QVector3D::lengthSquared() const noexcept +{ + return v[0] * v[0] + v[1] * v[1] + v[2] * v[2]; +} + +constexpr inline QVector3D &QVector3D::operator+=(QVector3D vector) noexcept +{ + v[0] += vector.v[0]; + v[1] += vector.v[1]; + v[2] += vector.v[2]; + return *this; +} + +constexpr inline QVector3D &QVector3D::operator-=(QVector3D vector) noexcept +{ + v[0] -= vector.v[0]; + v[1] -= vector.v[1]; + v[2] -= vector.v[2]; + return *this; +} + +constexpr inline QVector3D &QVector3D::operator*=(float factor) noexcept +{ + v[0] *= factor; + v[1] *= factor; + v[2] *= factor; + return *this; +} + +constexpr inline QVector3D &QVector3D::operator*=(QVector3D vector) noexcept +{ + v[0] *= vector.v[0]; + v[1] *= vector.v[1]; + v[2] *= vector.v[2]; + return *this; +} + +constexpr inline QVector3D &QVector3D::operator/=(float divisor) +{ + Q_ASSERT(divisor < 0 || divisor > 0); + v[0] /= divisor; + v[1] /= divisor; + v[2] /= divisor; + return *this; +} + +constexpr inline QVector3D &QVector3D::operator/=(QVector3D vector) +{ + Q_ASSERT(vector.v[0] > 0 || vector.v[0] < 0); + Q_ASSERT(vector.v[1] > 0 || vector.v[1] < 0); + Q_ASSERT(vector.v[2] > 0 || vector.v[2] < 0); + v[0] /= vector.v[0]; + v[1] /= vector.v[1]; + v[2] /= vector.v[2]; + return *this; +} + +constexpr inline float QVector3D::dotProduct(QVector3D v1, QVector3D v2) noexcept +{ + return v1.v[0] * v2.v[0] + v1.v[1] * v2.v[1] + v1.v[2] * v2.v[2]; +} + +constexpr inline QVector3D QVector3D::crossProduct(QVector3D v1, QVector3D v2) noexcept +{ + return QVector3D(v1.v[1] * v2.v[2] - v1.v[2] * v2.v[1], + v1.v[2] * v2.v[0] - v1.v[0] * v2.v[2], + v1.v[0] * v2.v[1] - v1.v[1] * v2.v[0]); +} + +inline QVector3D QVector3D::normal(QVector3D v1, QVector3D v2) noexcept +{ + return crossProduct(v1, v2).normalized(); +} + +inline QVector3D QVector3D::normal(QVector3D v1, QVector3D v2, QVector3D v3) noexcept +{ + return crossProduct((v2 - v1), (v3 - v1)).normalized(); +} + +inline float QVector3D::distanceToPoint(QVector3D point) const noexcept +{ + return (*this - point).length(); +} + +constexpr inline float QVector3D::distanceToPlane(QVector3D plane, QVector3D normal) const noexcept +{ + return dotProduct(*this - plane, normal); +} + +inline float QVector3D::distanceToPlane(QVector3D plane1, QVector3D plane2, QVector3D plane3) const noexcept +{ + QVector3D n = normal(plane2 - plane1, plane3 - plane1); + return dotProduct(*this - plane1, n); +} + +inline float QVector3D::distanceToLine(QVector3D point, QVector3D direction) const noexcept +{ + if (direction.isNull()) + return (*this - point).length(); + QVector3D p = point + dotProduct(*this - point, direction) * direction; + return (*this - p).length(); +} + +#ifndef QT_NO_VECTOR2D +constexpr inline QVector2D QVector3D::toVector2D() const noexcept +{ + return QVector2D(v[0], v[1]); +} +#endif +#ifndef QT_NO_VECTOR4D +constexpr inline QVector4D QVector3D::toVector4D() const noexcept +{ + return QVector4D(v[0], v[1], v[2], 0.0f); +} +#endif + +constexpr inline QPoint QVector3D::toPoint() const noexcept +{ + return QPoint(qRound(v[0]), qRound(v[1])); +} + +constexpr inline QPointF QVector3D::toPointF() const noexcept +{ + return QPointF(qreal(v[0]), qreal(v[1])); +} + +#ifndef QT_NO_DEBUG_STREAM +Q_GUI_EXPORT QDebug operator<<(QDebug dbg, QVector3D vector); +#endif + +#ifndef QT_NO_DATASTREAM +Q_GUI_EXPORT QDataStream &operator<<(QDataStream &, QVector3D ); +Q_GUI_EXPORT QDataStream &operator>>(QDataStream &, QVector3D &); +#endif + +#endif // QT_NO_VECTOR3D + + + +/***************************** QVector4D *****************************/ + +#ifndef QT_NO_VECTOR4D + +constexpr inline QVector4D::QVector4D() noexcept : v{0.0f, 0.0f, 0.0f, 0.0f} {} + +constexpr inline QVector4D::QVector4D(float xpos, float ypos, float zpos, float wpos) noexcept : v{xpos, ypos, zpos, wpos} {} + +constexpr inline QVector4D::QVector4D(QPoint point) noexcept : v{float(point.x()), float(point.y()), 0.0f, 0.0f} {} + +constexpr inline QVector4D::QVector4D(QPointF point) noexcept : v{float(point.x()), float(point.y()), 0.0f, 0.0f} {} + +#ifndef QT_NO_VECTOR2D +constexpr QVector4D::QVector4D(QVector2D vector) noexcept : v{vector[0], vector[1], 0.0f, 0.0f} {} +constexpr QVector4D::QVector4D(QVector2D vector, float zpos, float wpos) noexcept : v{vector[0], vector[1], zpos, wpos} {} +#endif +#ifndef QT_NO_VECTOR3D +constexpr QVector4D::QVector4D(QVector3D vector) noexcept : v{vector[0], vector[1], vector[2], 0.0f} {} +constexpr QVector4D::QVector4D(QVector3D vector, float wpos) noexcept : v{vector[0], vector[1], vector[2], wpos} {} +#endif + +constexpr inline bool QVector4D::isNull() const noexcept +{ + return qIsNull(v[0]) && qIsNull(v[1]) && qIsNull(v[2]) && qIsNull(v[3]); +} + +constexpr inline float QVector4D::x() const noexcept { return v[0]; } +constexpr inline float QVector4D::y() const noexcept { return v[1]; } +constexpr inline float QVector4D::z() const noexcept { return v[2]; } +constexpr inline float QVector4D::w() const noexcept { return v[3]; } + +constexpr inline void QVector4D::setX(float aX) noexcept { v[0] = aX; } +constexpr inline void QVector4D::setY(float aY) noexcept { v[1] = aY; } +constexpr inline void QVector4D::setZ(float aZ) noexcept { v[2] = aZ; } +constexpr inline void QVector4D::setW(float aW) noexcept { v[3] = aW; } + +constexpr inline float &QVector4D::operator[](int i) +{ + Q_ASSERT(uint(i) < 4u); + return v[i]; +} + +constexpr inline float QVector4D::operator[](int i) const +{ + Q_ASSERT(uint(i) < 4u); + return v[i]; +} + +inline float QVector4D::length() const noexcept +{ + return qHypot(v[0], v[1], v[2], v[3]); +} + +constexpr inline float QVector4D::lengthSquared() const noexcept +{ + return v[0] * v[0] + v[1] * v[1] + v[2] * v[2] + v[3] * v[3]; +} + +inline QVector4D QVector4D::normalized() const noexcept +{ + const float len = length(); + return qFuzzyIsNull(len - 1.0f) ? *this : qFuzzyIsNull(len) ? QVector4D() + : QVector4D(v[0] / len, v[1] / len, v[2] / len, v[3] / len); +} + +inline void QVector4D::normalize() noexcept +{ + const float len = length(); + if (qFuzzyIsNull(len - 1.0f) || qFuzzyIsNull(len)) + return; + + v[0] /= len; + v[1] /= len; + v[2] /= len; + v[3] /= len; +} + +constexpr inline QVector4D &QVector4D::operator+=(QVector4D vector) noexcept +{ + v[0] += vector.v[0]; + v[1] += vector.v[1]; + v[2] += vector.v[2]; + v[3] += vector.v[3]; + return *this; +} + +constexpr inline QVector4D &QVector4D::operator-=(QVector4D vector) noexcept +{ + v[0] -= vector.v[0]; + v[1] -= vector.v[1]; + v[2] -= vector.v[2]; + v[3] -= vector.v[3]; + return *this; +} + +constexpr inline QVector4D &QVector4D::operator*=(float factor) noexcept +{ + v[0] *= factor; + v[1] *= factor; + v[2] *= factor; + v[3] *= factor; + return *this; +} + +constexpr inline QVector4D &QVector4D::operator*=(QVector4D vector) noexcept +{ + v[0] *= vector.v[0]; + v[1] *= vector.v[1]; + v[2] *= vector.v[2]; + v[3] *= vector.v[3]; + return *this; +} + +constexpr inline QVector4D &QVector4D::operator/=(float divisor) +{ + Q_ASSERT(divisor < 0 || divisor > 0); + v[0] /= divisor; + v[1] /= divisor; + v[2] /= divisor; + v[3] /= divisor; + return *this; +} + +constexpr inline QVector4D &QVector4D::operator/=(QVector4D vector) +{ + Q_ASSERT(vector.v[0] > 0 || vector.v[0] < 0); + Q_ASSERT(vector.v[1] > 0 || vector.v[1] < 0); + Q_ASSERT(vector.v[2] > 0 || vector.v[2] < 0); + Q_ASSERT(vector.v[3] > 0 || vector.v[3] < 0); + v[0] /= vector.v[0]; + v[1] /= vector.v[1]; + v[2] /= vector.v[2]; + v[3] /= vector.v[3]; + return *this; +} + +constexpr float QVector4D::dotProduct(QVector4D v1, QVector4D v2) noexcept +{ + return v1.v[0] * v2.v[0] + v1.v[1] * v2.v[1] + v1.v[2] * v2.v[2] + v1.v[3] * v2.v[3]; +} + +#ifndef QT_NO_VECTOR2D + +constexpr inline QVector2D QVector4D::toVector2D() const noexcept +{ + return QVector2D(v[0], v[1]); +} + +constexpr inline QVector2D QVector4D::toVector2DAffine() const noexcept +{ + if (qIsNull(v[3])) + return QVector2D(); + return QVector2D(v[0] / v[3], v[1] / v[3]); +} + +#endif // QT_NO_VECTOR2D + +#ifndef QT_NO_VECTOR3D + +constexpr inline QVector3D QVector4D::toVector3D() const noexcept +{ + return QVector3D(v[0], v[1], v[2]); +} + +constexpr QVector3D QVector4D::toVector3DAffine() const noexcept +{ + if (qIsNull(v[3])) + return QVector3D(); + return QVector3D(v[0] / v[3], v[1] / v[3], v[2] / v[3]); +} + +#endif // QT_NO_VECTOR3D + +constexpr inline QPoint QVector4D::toPoint() const noexcept +{ + return QPoint(qRound(v[0]), qRound(v[1])); +} + +constexpr inline QPointF QVector4D::toPointF() const noexcept +{ + return QPointF(qreal(v[0]), qreal(v[1])); +} + +#ifndef QT_NO_DEBUG_STREAM +Q_GUI_EXPORT QDebug operator<<(QDebug dbg, QVector4D vector); +#endif + +#ifndef QT_NO_DATASTREAM +Q_GUI_EXPORT QDataStream &operator<<(QDataStream &, QVector4D ); +Q_GUI_EXPORT QDataStream &operator>>(QDataStream &, QVector4D &); +#endif + +#endif // QT_NO_VECTOR4D + + +QT_END_NAMESPACE + +/***************************** Tuple protocol *****************************/ + +namespace std { +#ifndef QT_NO_VECTOR2D + template <> + class tuple_size<QT_PREPEND_NAMESPACE(QVector2D)> : public integral_constant<size_t, 2> {}; + template <> + class tuple_element<0, QT_PREPEND_NAMESPACE(QVector2D)> { public: using type = float; }; + template <> + class tuple_element<1, QT_PREPEND_NAMESPACE(QVector2D)> { public: using type = float; }; +#endif // QT_NO_VECTOR2D + +#ifndef QT_NO_VECTOR3D + template <> + class tuple_size<QT_PREPEND_NAMESPACE(QVector3D)> : public integral_constant<size_t, 3> {}; + template <> + class tuple_element<0, QT_PREPEND_NAMESPACE(QVector3D)> { public: using type = float; }; + template <> + class tuple_element<1, QT_PREPEND_NAMESPACE(QVector3D)> { public: using type = float; }; + template <> + class tuple_element<2, QT_PREPEND_NAMESPACE(QVector3D)> { public: using type = float; }; +#endif // QT_NO_VECTOR3D + +#ifndef QT_NO_VECTOR4D + template <> + class tuple_size<QT_PREPEND_NAMESPACE(QVector4D)> : public integral_constant<size_t, 4> {}; + template <> + class tuple_element<0, QT_PREPEND_NAMESPACE(QVector4D)> { public: using type = float; }; + template <> + class tuple_element<1, QT_PREPEND_NAMESPACE(QVector4D)> { public: using type = float; }; + template <> + class tuple_element<2, QT_PREPEND_NAMESPACE(QVector4D)> { public: using type = float; }; + template <> + class tuple_element<3, QT_PREPEND_NAMESPACE(QVector4D)> { public: using type = float; }; +#endif // QT_NO_VECTOR4D +} + +#endif // QVECTORND_H |