|
|
|
|
@ -66,53 +66,11 @@ void GSMatrix2x2::store(void* m)
|
|
|
|
|
std::memcpy(m, E, sizeof(E));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
GSMatrix4x4::GSMatrix4x4(float e00, float e01, float e02, float e03, float e10, float e11, float e12, float e13,
|
|
|
|
|
float e20, float e21, float e22, float e23, float e30, float e31, float e32, float e33)
|
|
|
|
|
{
|
|
|
|
|
E[0][0] = e00;
|
|
|
|
|
E[0][1] = e01;
|
|
|
|
|
E[0][2] = e02;
|
|
|
|
|
E[0][3] = e03;
|
|
|
|
|
E[1][0] = e10;
|
|
|
|
|
E[1][1] = e11;
|
|
|
|
|
E[1][2] = e12;
|
|
|
|
|
E[1][3] = e13;
|
|
|
|
|
E[2][0] = e20;
|
|
|
|
|
E[2][1] = e21;
|
|
|
|
|
E[2][2] = e22;
|
|
|
|
|
E[2][3] = e23;
|
|
|
|
|
E[3][0] = e30;
|
|
|
|
|
E[3][1] = e31;
|
|
|
|
|
E[3][2] = e32;
|
|
|
|
|
E[3][3] = e33;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
GSMatrix4x4::GSMatrix4x4(const GSMatrix2x2& m)
|
|
|
|
|
{
|
|
|
|
|
E[0][0] = m.E[0][0];
|
|
|
|
|
E[0][1] = m.E[0][1];
|
|
|
|
|
E[0][2] = 0.0f;
|
|
|
|
|
E[0][3] = 0.0f;
|
|
|
|
|
E[1][0] = m.E[1][0];
|
|
|
|
|
E[1][1] = m.E[1][1];
|
|
|
|
|
E[1][2] = 0.0f;
|
|
|
|
|
E[1][3] = 0.0f;
|
|
|
|
|
E[2][0] = 0.0f;
|
|
|
|
|
E[2][1] = 0.0f;
|
|
|
|
|
E[2][2] = 1.0f;
|
|
|
|
|
E[2][3] = 0.0f;
|
|
|
|
|
E[3][0] = 0.0f;
|
|
|
|
|
E[3][1] = 0.0f;
|
|
|
|
|
E[3][2] = 0.0f;
|
|
|
|
|
E[3][3] = 1.0f;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
GSMatrix4x4 GSMatrix4x4::operator*(const GSMatrix4x4& m) const
|
|
|
|
|
ALWAYS_INLINE static void MatrixMult4x4(GSMatrix4x4& res, const GSMatrix4x4& lhs, const GSMatrix4x4& rhs)
|
|
|
|
|
{
|
|
|
|
|
// This isn't speedy by any means, but it's not hot code either.
|
|
|
|
|
GSMatrix4x4 res;
|
|
|
|
|
|
|
|
|
|
#define MultRC(rw, cl) E[rw][0] * m.E[0][cl] + E[rw][1] * m.E[1][cl] + E[rw][2] * m.E[2][cl] + E[rw][3] * m.E[3][cl]
|
|
|
|
|
#define MultRC(rw, cl) \
|
|
|
|
|
lhs.E[rw][0] * rhs.E[0][cl] + lhs.E[rw][1] * rhs.E[1][cl] + lhs.E[rw][2] * rhs.E[2][cl] + lhs.E[rw][3] * rhs.E[3][cl]
|
|
|
|
|
|
|
|
|
|
res.E[0][0] = MultRC(0, 0);
|
|
|
|
|
res.E[0][1] = MultRC(0, 1);
|
|
|
|
|
@ -132,75 +90,22 @@ GSMatrix4x4 GSMatrix4x4::operator*(const GSMatrix4x4& m) const
|
|
|
|
|
res.E[3][3] = MultRC(3, 3);
|
|
|
|
|
|
|
|
|
|
#undef MultRC
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
GSMatrix4x4 GSMatrix4x4::operator*(const GSMatrix4x4& m) const
|
|
|
|
|
{
|
|
|
|
|
GSMatrix4x4 res;
|
|
|
|
|
MatrixMult4x4(res, *this, m);
|
|
|
|
|
return res;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
GSMatrix4x4& GSMatrix4x4::operator*=(const GSMatrix4x4& m)
|
|
|
|
|
{
|
|
|
|
|
const GSMatrix4x4 copy(*this);
|
|
|
|
|
|
|
|
|
|
#define MultRC(rw, cl) \
|
|
|
|
|
copy.E[rw][0] * m.E[0][cl] + copy.E[rw][1] * m.E[1][cl] + copy.E[rw][2] * m.E[2][cl] + copy.E[rw][3] * m.E[3][cl]
|
|
|
|
|
|
|
|
|
|
E[0][0] = MultRC(0, 0);
|
|
|
|
|
E[0][1] = MultRC(0, 1);
|
|
|
|
|
E[0][2] = MultRC(0, 2);
|
|
|
|
|
E[0][3] = MultRC(0, 3);
|
|
|
|
|
E[1][0] = MultRC(1, 0);
|
|
|
|
|
E[1][1] = MultRC(1, 1);
|
|
|
|
|
E[1][2] = MultRC(1, 2);
|
|
|
|
|
E[1][3] = MultRC(1, 3);
|
|
|
|
|
E[2][0] = MultRC(2, 0);
|
|
|
|
|
E[2][1] = MultRC(2, 1);
|
|
|
|
|
E[2][2] = MultRC(2, 2);
|
|
|
|
|
E[2][3] = MultRC(2, 3);
|
|
|
|
|
E[3][0] = MultRC(3, 0);
|
|
|
|
|
E[3][1] = MultRC(3, 1);
|
|
|
|
|
E[3][2] = MultRC(3, 2);
|
|
|
|
|
E[3][3] = MultRC(3, 3);
|
|
|
|
|
|
|
|
|
|
#undef MultRC
|
|
|
|
|
|
|
|
|
|
MatrixMult4x4(*this, copy, m);
|
|
|
|
|
return *this;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
GSVector4 GSMatrix4x4::operator*(const GSVector4& v) const
|
|
|
|
|
{
|
|
|
|
|
const GSVector4 r0 = row(0);
|
|
|
|
|
const GSVector4 r1 = row(1);
|
|
|
|
|
const GSVector4 r2 = row(2);
|
|
|
|
|
const GSVector4 r3 = row(3);
|
|
|
|
|
|
|
|
|
|
return GSVector4(r0.dot(v), r1.dot(v), r2.dot(v), r3.dot(v));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
GSMatrix4x4 GSMatrix4x4::Identity()
|
|
|
|
|
{
|
|
|
|
|
GSMatrix4x4 res;
|
|
|
|
|
|
|
|
|
|
#define MultRC(rw, cl) E[rw][0] * m.E[0][cl] + E[rw][1] * m.E[1][cl] + E[rw][2] * m.E[2][cl] + E[rw][3] * m.E[3][cl]
|
|
|
|
|
|
|
|
|
|
res.E[0][0] = 1.0f;
|
|
|
|
|
res.E[0][1] = 0.0f;
|
|
|
|
|
res.E[0][2] = 0.0f;
|
|
|
|
|
res.E[0][3] = 0.0f;
|
|
|
|
|
res.E[1][0] = 0.0f;
|
|
|
|
|
res.E[1][1] = 1.0f;
|
|
|
|
|
res.E[1][2] = 0.0f;
|
|
|
|
|
res.E[1][3] = 0.0f;
|
|
|
|
|
res.E[2][0] = 0.0f;
|
|
|
|
|
res.E[2][1] = 0.0f;
|
|
|
|
|
res.E[2][2] = 1.0f;
|
|
|
|
|
res.E[2][3] = 0.0f;
|
|
|
|
|
res.E[3][0] = 0.0f;
|
|
|
|
|
res.E[3][1] = 0.0f;
|
|
|
|
|
res.E[3][2] = 0.0f;
|
|
|
|
|
res.E[3][3] = 1.0f;
|
|
|
|
|
|
|
|
|
|
return res;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
GSMatrix4x4 GSMatrix4x4::RotationX(float angle_in_radians)
|
|
|
|
|
{
|
|
|
|
|
const float sin_angle = std::sin(angle_in_radians);
|
|
|
|
|
@ -246,17 +151,7 @@ GSMatrix4x4 GSMatrix4x4::OffCenterOrthographicProjection(float width, float heig
|
|
|
|
|
return OffCenterOrthographicProjection(0.0f, 0.0f, width, height, zNear, zFar);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
GSVector4 GSMatrix4x4::row(size_t i) const
|
|
|
|
|
{
|
|
|
|
|
return GSVector4::load<true>(&E[i][0]);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
GSVector4 GSMatrix4x4::col(size_t i) const
|
|
|
|
|
{
|
|
|
|
|
return GSVector4(E[0][i], E[1][i], E[2][i], E[3][i]);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
GSMatrix4x4 GSMatrix4x4::Invert() const
|
|
|
|
|
GSMatrix4x4 GSMatrix4x4::invert() const
|
|
|
|
|
{
|
|
|
|
|
GSMatrix4x4 ret;
|
|
|
|
|
|
|
|
|
|
|