MRVector3.h

Go to the documentation of this file.

#pragma once
 
#include "MRMacros.h"
#include "MRMesh/MRUnsigned.h"
#include "MRMeshFwd.h"
#include "MRConstants.h"
#include "MRPch/MRBindingMacros.h"
#include <algorithm>
#include <cmath>
#include <cstring>
#include <iosfwd>
#include <utility>
#if MR_HAS_REQUIRES
#include <concepts>
#endif
 
namespace MR
{
 
 
#ifdef _MSC_VER
#pragma warning(push)
#pragma warning(disable: 4804) 
#pragma warning(disable: 4146) 
#endif

template <typename T>
struct Vector3
{
    using ValueType = T;
    using MatrixType = Matrix3<T>;
    using SymMatrixType = SymMatrix3<T>;
    static constexpr int elements = 3;
 
    T x, y, z;
 
    constexpr Vector3() noexcept : x( 0 ), y( 0 ), z( 0 )
    {
        static_assert( sizeof( Vector3<ValueType> ) == elements * sizeof( ValueType ), "Struct size invalid" );
        static_assert( elements == 3, "Invalid number of elements" );
    }
    explicit Vector3( NoInit ) noexcept { }
    constexpr Vector3( T x, T y, T z ) noexcept : x( x ), y( y ), z( z ) { }
 
    template <typename U> MR_REQUIRES_IF_SUPPORTED( std::constructible_from<T, U> )
    explicit constexpr Vector3( const Vector2<U> & v ) noexcept : x( v.x ), y( v.y ), z( 0 ) { }
 
    static constexpr Vector3 diagonal( T a ) noexcept { return Vector3( a, a, a ); }
    static constexpr Vector3 plusX() noexcept { return Vector3( 1, 0, 0 ); }
    static constexpr Vector3 plusY() noexcept { return Vector3( 0, 1, 0 ); }
    static constexpr Vector3 plusZ() noexcept { return Vector3( 0, 0, 1 ); }
    static constexpr Vector3 minusX() noexcept MR_REQUIRES_IF_SUPPORTED( !std::is_unsigned_v<T> ) { return Vector3( -1, 0, 0 ); }
    static constexpr Vector3 minusY() noexcept MR_REQUIRES_IF_SUPPORTED( !std::is_unsigned_v<T> ) { return Vector3( 0, -1, 0 ); }
    static constexpr Vector3 minusZ() noexcept MR_REQUIRES_IF_SUPPORTED( !std::is_unsigned_v<T> ) { return Vector3( 0, 0, -1 ); }

    template <typename U> MR_REQUIRES_IF_SUPPORTED( !std::is_same_v<T, U> )
    constexpr explicit Vector3( const Vector3<U> & v ) noexcept : x( T( v.x ) ), y( T( v.y ) ), z( T( v.z ) ) { }
 
    constexpr const T & operator []( int e ) const noexcept { return *( ( ValueType *)this + e ); }
    constexpr       T & operator []( int e )       noexcept { return *( ( ValueType *)this + e ); }
 
    T lengthSq() const { return x * x + y * y + z * z; }
    auto length() const
    {
        using std::sqrt;
        return sqrt( lengthSq() );
    }
 
    [[nodiscard]] Vector3 normalized() const MR_REQUIRES_IF_SUPPORTED( std::floating_point<T> )
    {
        auto len = length();
        if ( len <= 0 )
            return {};
        return ( 1 / len ) * (*this);
    }

    Vector3 furthestBasisVector() const MR_REQUIRES_IF_SUPPORTED( !std::is_same_v<T, bool> );

    std::pair<Vector3, Vector3> perpendicular() const MR_REQUIRES_IF_SUPPORTED( std::floating_point<T> );

    Vector3 transformed( const AffineXf3OrPlaceholder<T>* xf ) const MR_REQUIRES_IF_SUPPORTED( std::floating_point<T> )
    {
        return xf ? ( *xf )( *this ) : *this;
    }

    void unsignZeroValues() MR_REQUIRES_IF_SUPPORTED( std::floating_point<T> )
    {
        for ( auto i = 0; i < elements; ++i )
            if ( (*this)[i] == 0.f && std::signbit( (*this)[i] ) )
                (*this)[i] = 0.f;
    }
 
    [[nodiscard]] bool isFinite() const MR_REQUIRES_IF_SUPPORTED( std::floating_point<T> )
    {
        return std::isfinite( x ) && std::isfinite( y ) && std::isfinite( z );
    }
 
    [[nodiscard]] friend constexpr bool operator ==( const Vector3<T> & a, const Vector3<T> & b ) { return a.x == b.x && a.y == b.y && a.z == b.z; }
    [[nodiscard]] friend constexpr bool operator !=( const Vector3<T> & a, const Vector3<T> & b ) { return !( a == b ); }

 
    [[nodiscard]] friend constexpr const Vector3<T> & operator +( const Vector3<T> & a ) { return a; }
    [[nodiscard]] friend constexpr auto operator -( const Vector3<T> & a ) -> Vector3<decltype( -std::declval<T>() )> { return { -a.x, -a.y, -a.z }; }
 
    [[nodiscard]] friend constexpr auto operator +( const Vector3<T> & a, const Vector3<T> & b ) -> Vector3<decltype( std::declval<T>() + std::declval<T>() )> { return { a.x + b.x, a.y + b.y, a.z + b.z }; }
    [[nodiscard]] friend constexpr auto operator -( const Vector3<T> & a, const Vector3<T> & b ) -> Vector3<decltype( std::declval<T>() - std::declval<T>() )> { return { a.x - b.x, a.y - b.y, a.z - b.z }; }
    [[nodiscard]] friend constexpr auto operator *(               T    a, const Vector3<T> & b ) -> Vector3<decltype( std::declval<T>() * std::declval<T>() )> { return { a * b.x, a * b.y, a * b.z }; }
    [[nodiscard]] friend constexpr auto operator *( const Vector3<T> & b,               T    a ) -> Vector3<decltype( std::declval<T>() * std::declval<T>() )> { return { a * b.x, a * b.y, a * b.z }; }
    [[nodiscard]] friend constexpr auto operator /(       Vector3<T>   b,               T    a ) -> Vector3<decltype( std::declval<T>() / std::declval<T>() )>
    {
        if constexpr ( std::is_integral_v<T> )
            return { b.x / a, b.y / a, b.z / a };
        else
            return b * ( 1 / a );
    }
 
    friend constexpr Vector3<T> & operator +=( Vector3<T> & a, const Vector3<T> & b ) { a.x += b.x; a.y += b.y; a.z += b.z; return a; }
    friend constexpr Vector3<T> & operator -=( Vector3<T> & a, const Vector3<T> & b ) { a.x -= b.x; a.y -= b.y; a.z -= b.z; return a; }
    friend constexpr Vector3<T> & operator *=( Vector3<T> & a,               T    b ) { a.x *= b; a.y *= b; a.z *= b; return a; }
    friend constexpr Vector3<T> & operator /=( Vector3<T> & a,               T    b )
    {
        if constexpr ( std::is_integral_v<T> )
            { a.x /= b; a.y /= b; a.z /= b; return a; }
        else
            return a *= ( 1 / b );
    }
 
    friend std::ostream& operator<<( std::ostream& s, const Vector3& vec )
    {
        return s << vec.x << ' ' << vec.y << ' ' << vec.z;
    }
 
    friend std::istream& operator>>( std::istream& s, Vector3& vec )
    {
        return s >> vec.x >> vec.y >> vec.z;
    }
 

 
    MR_BIND_IGNORE friend auto begin( const Vector3& v ) { return &v[0]; }
    MR_BIND_IGNORE friend auto begin( Vector3& v ) { return &v[0]; }
    MR_BIND_IGNORE friend auto end( const Vector3& v ) { return &v[3]; }
    MR_BIND_IGNORE friend auto end( Vector3& v ) { return &v[3]; }
};

 

template <typename T>
inline T distanceSq( const Vector3<T> & a, const Vector3<T> & b )
{
    return ( a - b ).lengthSq();
}

template <typename T>
inline T distance( const Vector3<T> & a, const Vector3<T> & b )
{
    return ( a - b ).length();
}

template <typename T>
inline Vector3<T> cross( const Vector3<T> & a, const Vector3<T> & b )
{
    return {
        a.y * b.z - a.z * b.y,
        a.z * b.x - a.x * b.z,
        a.x * b.y - a.y * b.x
    };
}

template <typename T>
inline auto dot( const Vector3<T> & a, const Vector3<T> & b ) -> decltype( a.x * b.x )
{
    return a.x * b.x + a.y * b.y + a.z * b.z;
}

template <typename T>
inline T sqr( const Vector3<T> & a )
{
    return a.lengthSq();
}

template <typename T>
inline T mixed( const Vector3<T> & a, const Vector3<T> & b, const Vector3<T> & c )
{
    return dot( a, cross( b, c ) );
}

template <typename T>
inline Vector3<T> mult( const Vector3<T>& a, const Vector3<T>& b )
{
    return { a.x * b.x,a.y * b.y,a.z * b.z };
}

template <typename T>
inline Vector3<T> div( const Vector3<T>& a, const Vector3<T>& b )
{
    return { a.x / b.x, a.y / b.y, a.z / b.z };
}
 

template <typename T>
inline T angle( const Vector3<T> & a, const Vector3<T> & b )
{
    return std::atan2( cross( a, b ).length(), dot( a, b ) );
}
 
template <typename T>
inline Vector3<T> Vector3<T>::furthestBasisVector() const MR_REQUIRES_IF_SUPPORTED( !std::is_same_v<T, bool> )
{
    using std::abs; 
    using Unsigned::abs; 
    if ( abs( x ) < abs( y ) )
        return ( abs( x ) < abs( z ) ) ? Vector3( 1, 0, 0 ) : Vector3( 0, 0, 1 );
    else
        return ( abs( y ) < abs( z ) ) ? Vector3( 0, 1, 0 ) : Vector3( 0, 0, 1 );
}
 
template <typename T>
inline std::pair<Vector3<T>, Vector3<T>> Vector3<T>::perpendicular() const MR_REQUIRES_IF_SUPPORTED( std::floating_point<T> )
{
    std::pair<Vector3<T>, Vector3<T>> res;
    auto c1 = furthestBasisVector();
    res.first  = cross( *this, c1 ).normalized();
    res.second = cross( *this, res.first ).normalized();
    return res;
}

template <typename T>
Vector3<T> unitVector3( T azimuth, T altitude )
{
    const auto zenithAngle = T( PI2 ) - altitude;
    return
    {
        std::sin( zenithAngle ) * std::cos( azimuth ),
        std::sin( zenithAngle ) * std::sin( azimuth ),
        std::cos( zenithAngle )
    };
}

 
#ifdef _MSC_VER
#pragma warning(pop)
#endif
 
}
 
template<>
struct std::hash<MR::Vector3f>
{
    size_t operator()( MR::Vector3f const& p ) const noexcept
    {
        std::uint64_t xy;
        std::uint32_t z;
        static_assert( sizeof( float ) == sizeof( std::uint32_t ) );
        std::memcpy( &xy, &p.x, sizeof( std::uint64_t ) );
        std::memcpy( &z, &p.z, sizeof( std::uint32_t ) );
        return size_t( xy ) ^ ( size_t( z ) << 16 );
    }
};