MRMatrix2.h

Go to the documentation of this file.

#pragma once
 
#include "MRVector2.h"
#include "MRConstants.h"
 
#include <iosfwd>
 
namespace MR
{
 
 
#ifdef _MSC_VER
#pragma warning(push)
#pragma warning(disable: 4804) 
#pragma warning(disable: 4146) 
#endif
 
template <typename T>
struct Matrix2
{
    using ValueType = T;
    using VectorType = Vector2<T>;
 
    Vector2<T> x{ 1, 0 };
    Vector2<T> y{ 0, 1 };
 
    constexpr Matrix2() noexcept
    {
        static_assert( sizeof( Matrix2<ValueType> ) == 2 * sizeof( VectorType ), "Struct size invalid" );
    }
    constexpr Matrix2( const Vector2<T> & x, const Vector2<T> & y ) : x( x ), y( y ) { }
    template <typename U>
    constexpr explicit Matrix2( const Matrix2<U> & m ) : x( m.x ), y( m.y ) { }
    static constexpr Matrix2 zero() noexcept { return Matrix2( Vector2<T>(), Vector2<T>() ); }
    static constexpr Matrix2 identity() noexcept { return Matrix2(); }
    static constexpr Matrix2 scale( T s ) noexcept { return Matrix2( { s, T(0) }, { T(0), s } ); }
    static constexpr Matrix2 scale( T sx, T sy ) noexcept { return Matrix2( { sx, T(0) }, { T(0), sy } ); }
    static constexpr Matrix2 scale( const Vector2<T> & s ) noexcept { return Matrix2( { s.x, T(0) }, { T(0), s.y } ); }
    static constexpr Matrix2 rotation( T angle ) noexcept MR_REQUIRES_IF_SUPPORTED( std::is_floating_point_v<T> );
    static constexpr Matrix2 rotation( const Vector2<T> & from, const Vector2<T> & to ) noexcept MR_REQUIRES_IF_SUPPORTED( std::is_floating_point_v<T> );
    static constexpr Matrix2 fromRows( const Vector2<T> & x, const Vector2<T> & y ) noexcept { return Matrix2( x, y ); }
    static constexpr Matrix2 fromColumns( const Vector2<T> & x, const Vector2<T> & y ) noexcept { return Matrix2( x, y ).transposed(); }
 
    constexpr const Vector2<T> & operator []( int row ) const noexcept { return *( ( VectorType* )this + row ); }
    constexpr       Vector2<T> & operator []( int row )       noexcept { return *( ( VectorType* )this + row ); }
 
    constexpr Vector2<T> col( int i ) const noexcept { return { x[i], y[i] }; }
 
    constexpr T trace() const noexcept { return x.x + y.y; }
    constexpr T normSq() const noexcept { return x.lengthSq() + y.lengthSq(); }
    constexpr auto norm() const noexcept
    {
        using std::sqrt;
        return sqrt( normSq() );
    }
    constexpr T det() const noexcept;
    constexpr Matrix2<T> inverse() const noexcept MR_REQUIRES_IF_SUPPORTED( std::is_floating_point_v<T> );
    constexpr Matrix2<T> transposed() const noexcept;
 
    [[nodiscard]] friend constexpr bool operator ==( const Matrix2<T> & a, const Matrix2<T> & b ) { return a.x == b.x && a.y == b.y; }
    [[nodiscard]] friend constexpr bool operator !=( const Matrix2<T> & a, const Matrix2<T> & b ) { return !( a == b ); }
 
 
    [[nodiscard]] friend constexpr auto operator +( const Matrix2<T> & a, const Matrix2<T> & b ) -> Matrix2<decltype( std::declval<T>() + std::declval<T>() )> { return { a.x + b.x, a.y + b.y }; }
    [[nodiscard]] friend constexpr auto operator -( const Matrix2<T> & a, const Matrix2<T> & b ) -> Matrix2<decltype( std::declval<T>() - std::declval<T>() )> { return { a.x - b.x, a.y - b.y }; }
    [[nodiscard]] friend constexpr auto operator *(               T    a, const Matrix2<T> & b ) -> Matrix2<decltype( std::declval<T>() * std::declval<T>() )> { return { a * b.x, a * b.y }; }
    [[nodiscard]] friend constexpr auto operator *( const Matrix2<T> & b,               T    a ) -> Matrix2<decltype( std::declval<T>() * std::declval<T>() )> { return { a * b.x, a * b.y }; }
    [[nodiscard]] friend constexpr auto operator /(       Matrix2<T>   b,               T    a ) -> Matrix2<decltype( std::declval<T>() / std::declval<T>() )>
    {
        if constexpr ( std::is_integral_v<T> )
            return { b.x / a, b.y / a };
        else
            return b * ( 1 / a );
    }
 
    friend constexpr Matrix2<T> & operator +=( Matrix2<T> & a, const Matrix2<T> & b ) { a.x += b.x; a.y += b.y; return a; }
    friend constexpr Matrix2<T> & operator -=( Matrix2<T> & a, const Matrix2<T> & b ) { a.x -= b.x; a.y -= b.y; return a; }
    friend constexpr Matrix2<T> & operator *=( Matrix2<T> & a,               T    b ) { a.x *= b; a.y *= b; return a; }
    friend constexpr Matrix2<T> & operator /=( Matrix2<T> & a,               T    b )
    {
        if constexpr ( std::is_integral_v<T> )
            { a.x /= b; a.y /= b; return a; }
        else
            return a *= ( 1 / b );
    }
 
    [[nodiscard]] friend constexpr auto operator *( const Matrix2<T> & a, const Vector2<T> & b ) -> Vector2<decltype( dot( std::declval<Vector2<T>>(), std::declval<Vector2<T>>() ) )>
    {
        return { dot( a.x, b ), dot( a.y, b ) };
    }
 
    [[nodiscard]] friend constexpr auto operator *( const Matrix2<T> & a, const Matrix2<T> & b ) -> Matrix2<decltype( dot( std::declval<Vector2<T>>(), std::declval<Vector2<T>>() ) )>
    {
        Matrix2<decltype( dot( std::declval<Vector2<T>>(), std::declval<Vector2<T>>() ) )> res;
        for ( int i = 0; i < 2; ++i )
            for ( int j = 0; j < 2; ++j )
                res[i][j] = dot( a[i], b.col(j) );
        return res;
    }
 
    friend std::ostream& operator<<( std::ostream& s, const Matrix2& mat )
    {
        return s << mat.x << '\n' << mat.y << '\n';
    }
 
    friend std::istream& operator>>( std::istream& s, Matrix2& mat )
    {
        return s >> mat.x >> mat.y;
    }
};
 
 
template <typename T>
inline auto dot( const Matrix2<T> & a, const Matrix2<T> & b ) -> decltype( dot( a.x, b.x ) )
{
    return dot( a.x, b.x ) + dot( a.y, b.y );
}
 
template <typename T>
inline Matrix2<T> outer( const Vector2<T> & a, const Vector2<T> & b )
{
    return { a.x * b, a.y * b };
}
 
template <typename T>
constexpr Matrix2<T> Matrix2<T>::rotation( T angle ) noexcept MR_REQUIRES_IF_SUPPORTED( std::is_floating_point_v<T> )
{
    T c = cos( angle );
    T s = sin( angle );
    return {
        { c, -s },
        { s,  c }
    };
}
 
template <typename T>
constexpr Matrix2<T> Matrix2<T>::rotation( const Vector2<T> & from, const Vector2<T> & to ) noexcept MR_REQUIRES_IF_SUPPORTED( std::is_floating_point_v<T> )
{
    const auto x = cross( from, to );
    if ( x > 0 )
        return rotation( angle( from, to ) );
    if ( x < 0 )
        return rotation( -angle( from, to ) );
    if ( dot( from, to ) >= 0 )
        return {}; 
    return rotation( T( PI ) );
}
 
template <typename T>
constexpr T Matrix2<T>::det() const noexcept
{
    return x.x * y.y - x.y * y.x;
}
 
template <typename T>
constexpr Matrix2<T> Matrix2<T>::inverse() const noexcept MR_REQUIRES_IF_SUPPORTED( std::is_floating_point_v<T> )
{
    auto det = this->det();
    if ( det == 0 )
        return {};
    return Matrix2<T>
    {
        {   y.y, - x.y },
        { - y.x,   x.x }
    } / det;
}
 
template <typename T>
constexpr Matrix2<T> Matrix2<T>::transposed() const noexcept
{
    return Matrix2<T>
    {
        { x.x, y.x },
        { x.y, y.y }
    };
}
 
 
#ifdef _MSC_VER
#pragma warning(pop)
#endif
 
}