m_angle.hpp

#pragma once
#include <types.h>
#include <lib/nw4r/math/trigonometry.hpp>
#include <lib/rvl/mtx/vec.h>
 
struct mAng {
 
    mAng() {}
 
    mAng(const s16 *p) { mAngle = *p; }
 
    mAng(s16 x) { mAngle = x; }
 
    operator s16*() { return &mAngle; }
 
    operator const s16*() const { return &mAngle; }
 
    mAng &operator+=(const mAng &v) { mAngle += v.mAngle; return *this; }
 
    mAng &operator-=(const mAng &v) { mAngle -= v.mAngle; return *this; }
 
    mAng operator+() const { return *this; }
 
    mAng operator-() const { return mAng(-mAngle); }
 
    mAng operator+(const mAng &v) const { return mAng(mAngle + v.mAngle); }
 
    mAng operator-(const mAng &v) const { return mAng(mAngle - v.mAngle); }
 
    bool operator==(const mAng &v) const { return mAngle == v.mAngle; }
 
    bool operator!=(const mAng &v) const { return mAngle != v.mAngle; }
 
    float sin() const { return nw4r::math::SinS(mAngle); }
 
    float cos() const { return nw4r::math::CosS(mAngle); }
 
    s16 mAngle; 
};
 
class mAng3_c {
public:
 
    mAng3_c() {}
 
    mAng3_c(const s16 *p) { x = p[0]; y = p[1]; z = p[2]; }
 
    mAng3_c(s16 fx, s16 fy, s16 fz) { x = fx; y = fy; z = fz; }
 
    mAng3_c(const S16Vec &v) { x = v.x; y = v.y; z = v.z; }
 
    operator s16*() { return &x; }
 
    operator const s16*() const { return &x; }
 
    operator S16Vec*() { return (S16Vec*)&x; }
 
    operator const S16Vec*() const { return (const S16Vec*)&x; }
 
    mAng3_c &operator+=(const mAng3_c &v) { x += v.x; y += v.y; z += v.z; return *this; }
 
    mAng3_c &operator-=(const mAng3_c &v) { x -= v.x; y -= v.y; z -= v.z; return *this; }
 
    mAng3_c operator+() const { return *this; }
 
    mAng3_c operator-() const { return mAng3_c(-x, -y, -z); }
 
    mAng3_c operator+(const mAng3_c &v) const { return mAng3_c(x + v.x, y + v.y, z + v.z); }
 
    mAng3_c operator-(const mAng3_c &v) const { return mAng3_c(x - v.x, y - v.y, z - v.z); }
 
    bool operator==(const mAng3_c &v) const { return x == v.x && y == v.y && z == v.z; }
 
    bool operator!=(const mAng3_c &v) const { return x != v.x || y != v.y || z != v.z; }
 
    s16 x; 
    s16 y; 
    s16 z; 
 
    static mAng3_c Zero; 
    static mAng3_c Ex; 
    static mAng3_c Ey; 
    static mAng3_c Ez; 
};