#pragma once

#ifndef POSITIVE_PITCH_IS_DOWN
#define POSITIVE_PITCH_IS_DOWN 1
#endif

#if POSITIVE_PITCH_IS_DOWN
    #define fixedmakevectors makevectors
    #define FIXED_MAKE_VECTORS MAKE_VECTORS
    #define FIXED_MAKE_VECTORS_NEW MAKE_VECTORS_NEW
    noref vector _fixedvectoangles;
    #define fixedvectoangles(a) (_fixedvectoangles = vectoangles(a), _fixedvectoangles.x *= -1, _fixedvectoangles)
    noref vector _fixedvectoangles2;
    #define fixedvectoangles2(a, b) (_fixedvectoangles2 = vectoangles2(a, b), _fixedvectoangles2.x *= -1, _fixedvectoangles2)
#else
    void fixedmakevectors(vector a)
    {
        // a makevectors that actually inverts vectoangles
        a.x = -a.x;
        makevectors(a);
    }
    #define FIXED_MAKE_VECTORS(angles, forward, right, up) MACRO_BEGIN { \
        fixedmakevectors(angles); \
        forward = v_forward; \
        right = v_right; \
        up = v_up; \
        v_forward = VEC_NAN; \
        v_right = VEC_NAN; \
        v_up = VEC_NAN; \
    } MACRO_END
    #define FIXED_MAKE_VECTORS_NEW(angles, forward, right, up) \
        vector forward = '0 0 0'; \
        vector right = '0 0 0'; \
        vector up = '0 0 0'; \
        FIXED_MAKE_VECTORS(angles, forward, right, up);
    #define fixedvectoangles2 vectoangles2
    #define fixedvectoangles vectoangles
#endif

vector AnglesTransform_Apply(vector transform, vector v);
vector AnglesTransform_Multiply(vector t1, vector t2); // A B
vector AnglesTransform_Invert(vector transform);
vector AnglesTransform_TurnDirectionFU(vector transform);
vector AnglesTransform_TurnDirectionFR(vector transform);
vector AnglesTransform_RightDivide(vector to_transform, vector from_transform); // A B^-1
vector AnglesTransform_LeftDivide(vector from_transform, vector to_transform); // A^-1 B

vector AnglesTransform_Normalize(vector t, float minimize_roll); // makes sure all angles are in their range: yaw in -180..180, pitch in -90..90, roll in -180..180 (or if minimize_roll is set, pitch in -180..180, roll in -90..90)

vector AnglesTransform_ApplyToAngles(vector transform, vector v);
vector AnglesTransform_ApplyToVAngles(vector transform, vector v);
vector AnglesTransform_FromAngles(vector v);
vector AnglesTransform_ToAngles(vector v);
vector AnglesTransform_FromVAngles(vector v);
vector AnglesTransform_ToVAngles(vector v);

// transformed = original * transform + postshift
vector AnglesTransform_Multiply_GetPostShift(vector sf0, vector st0, vector t1, vector st1);
vector AnglesTransform_PrePostShift_GetPostShift(vector sf, vector t, vector st);