Implemented kraken::Matrix2
This commit is contained in:
@@ -9,6 +9,7 @@ set(PUBLIC_HEADERS
|
|||||||
include/aabb.h
|
include/aabb.h
|
||||||
include/hitinfo.h
|
include/hitinfo.h
|
||||||
include/kraken-math.h
|
include/kraken-math.h
|
||||||
|
include/matrix2.h
|
||||||
include/matrix4.h
|
include/matrix4.h
|
||||||
include/quaternion.h
|
include/quaternion.h
|
||||||
include/scalar.h
|
include/scalar.h
|
||||||
@@ -23,6 +24,7 @@ set(SRCS
|
|||||||
src/aabb.cpp
|
src/aabb.cpp
|
||||||
src/hitinfo.cpp
|
src/hitinfo.cpp
|
||||||
src/krhelpers.cpp
|
src/krhelpers.cpp
|
||||||
|
src/matrix2.cpp
|
||||||
src/matrix4.cpp
|
src/matrix4.cpp
|
||||||
src/quaternion.cpp
|
src/quaternion.cpp
|
||||||
src/scalar.cpp
|
src/scalar.cpp
|
||||||
|
|||||||
@@ -36,6 +36,7 @@
|
|||||||
#include "vector3.h"
|
#include "vector3.h"
|
||||||
#include "vector4.h"
|
#include "vector4.h"
|
||||||
#include "vector2i.h"
|
#include "vector2i.h"
|
||||||
|
#include "matrix2.h"
|
||||||
#include "matrix4.h"
|
#include "matrix4.h"
|
||||||
#include "quaternion.h"
|
#include "quaternion.h"
|
||||||
#include "aabb.h"
|
#include "aabb.h"
|
||||||
|
|||||||
106
include/matrix2.h
Normal file
106
include/matrix2.h
Normal file
@@ -0,0 +1,106 @@
|
|||||||
|
//
|
||||||
|
// Matrix2.h
|
||||||
|
// Kraken
|
||||||
|
//
|
||||||
|
// Copyright 2018 Kearwood Gilbert. All rights reserved.
|
||||||
|
//
|
||||||
|
// Redistribution and use in source and binary forms, with or without modification, are
|
||||||
|
// permitted provided that the following conditions are met:
|
||||||
|
//
|
||||||
|
// 1. Redistributions of source code must retain the above copyright notice, this list of
|
||||||
|
// conditions and the following disclaimer.
|
||||||
|
//
|
||||||
|
// 2. Redistributions in binary form must reproduce the above copyright notice, this list
|
||||||
|
// of conditions and the following disclaimer in the documentation and/or other materials
|
||||||
|
// provided with the distribution.
|
||||||
|
//
|
||||||
|
// THIS SOFTWARE IS PROVIDED BY KEARWOOD GILBERT ''AS IS'' AND ANY EXPRESS OR IMPLIED
|
||||||
|
// WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND
|
||||||
|
// FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL KEARWOOD GILBERT OR
|
||||||
|
// CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||||
|
// CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
|
||||||
|
// SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
|
||||||
|
// ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
||||||
|
// NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
|
||||||
|
// ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
//
|
||||||
|
// The views and conclusions contained in the software and documentation are those of the
|
||||||
|
// authors and should not be interpreted as representing official policies, either expressed
|
||||||
|
// or implied, of Kearwood Gilbert.
|
||||||
|
//
|
||||||
|
|
||||||
|
#include "vector2.h"
|
||||||
|
|
||||||
|
#ifndef KRAKEN_MATRIX2_H
|
||||||
|
#define KRAKEN_MATRIX2_H
|
||||||
|
|
||||||
|
namespace kraken {
|
||||||
|
|
||||||
|
class Matrix2 {
|
||||||
|
public:
|
||||||
|
|
||||||
|
union {
|
||||||
|
struct {
|
||||||
|
Vector2 axis_x, axis_y;
|
||||||
|
};
|
||||||
|
// Matrix components, in column-major order
|
||||||
|
float c[4];
|
||||||
|
};
|
||||||
|
|
||||||
|
// Default initializer - Creates an identity matrix
|
||||||
|
void init();
|
||||||
|
|
||||||
|
void init(float *pMat);
|
||||||
|
|
||||||
|
void init(const Vector2 &new_axis_x, const Vector2 &new_axis_y);
|
||||||
|
|
||||||
|
void init(const Matrix2 &m);
|
||||||
|
|
||||||
|
// Overload comparison operator
|
||||||
|
bool operator==(const Matrix2 &m) const;
|
||||||
|
|
||||||
|
// Overload compound multiply operator
|
||||||
|
Matrix2& operator*=(const Matrix2 &m);
|
||||||
|
|
||||||
|
float& operator[](unsigned i);
|
||||||
|
float operator[](unsigned i) const;
|
||||||
|
|
||||||
|
// Overload multiply operator
|
||||||
|
//Matrix4& operator*(const Matrix4 &m);
|
||||||
|
Matrix2 operator*(const Matrix2 &m) const;
|
||||||
|
|
||||||
|
float *getPointer();
|
||||||
|
|
||||||
|
void scale(float x, float y);
|
||||||
|
void scale(const Vector2 &v);
|
||||||
|
void scale(float s);
|
||||||
|
void rotate(float angle);
|
||||||
|
bool invert();
|
||||||
|
void transpose();
|
||||||
|
|
||||||
|
static Matrix2 Invert(const Matrix2 &m);
|
||||||
|
static Matrix2 Transpose(const Matrix2 &m);
|
||||||
|
static Vector2 Dot(const Matrix2 &m, const Vector2 &v);
|
||||||
|
|
||||||
|
static Matrix2 Rotation(float);
|
||||||
|
static Matrix2 Scaling(const Vector2 &v);
|
||||||
|
static Matrix2 Identity();
|
||||||
|
};
|
||||||
|
static_assert(std::is_pod<Matrix2>::value, "kraken::Matrix2 must be a POD type.");
|
||||||
|
|
||||||
|
} // namespace kraken
|
||||||
|
|
||||||
|
namespace std {
|
||||||
|
template<>
|
||||||
|
struct hash<kraken::Matrix2> {
|
||||||
|
public:
|
||||||
|
size_t operator()(const kraken::Matrix2 &s) const
|
||||||
|
{
|
||||||
|
size_t h1 = hash<kraken::Vector2>()(s.axis_x);
|
||||||
|
size_t h2 = hash<kraken::Vector2>()(s.axis_y);
|
||||||
|
return h1 ^ (h2 << 1);
|
||||||
|
}
|
||||||
|
};
|
||||||
|
} // namespace std
|
||||||
|
|
||||||
|
#endif // KRAKEN_MATRIX2_H
|
||||||
205
src/matrix2.cpp
Normal file
205
src/matrix2.cpp
Normal file
@@ -0,0 +1,205 @@
|
|||||||
|
//
|
||||||
|
// matrix2.cpp
|
||||||
|
// Kraken
|
||||||
|
//
|
||||||
|
// Copyright 2018 Kearwood Gilbert. All rights reserved.
|
||||||
|
//
|
||||||
|
// Redistribution and use in source and binary forms, with or without modification, are
|
||||||
|
// permitted provided that the following conditions are met:
|
||||||
|
//
|
||||||
|
// 1. Redistributions of source code must retain the above copyright notice, this list of
|
||||||
|
// conditions and the following disclaimer.
|
||||||
|
//
|
||||||
|
// 2. Redistributions in binary form must reproduce the above copyright notice, this list
|
||||||
|
// of conditions and the following disclaimer in the documentation and/or other materials
|
||||||
|
// provided with the distribution.
|
||||||
|
//
|
||||||
|
// THIS SOFTWARE IS PROVIDED BY KEARWOOD GILBERT ''AS IS'' AND ANY EXPRESS OR IMPLIED
|
||||||
|
// WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND
|
||||||
|
// FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL KEARWOOD GILBERT OR
|
||||||
|
// CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||||
|
// CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
|
||||||
|
// SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
|
||||||
|
// ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
||||||
|
// NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
|
||||||
|
// ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
//
|
||||||
|
// The views and conclusions contained in the software and documentation are those of the
|
||||||
|
// authors and should not be interpreted as representing official policies, either expressed
|
||||||
|
// or implied, of Kearwood Gilbert.
|
||||||
|
//
|
||||||
|
|
||||||
|
#include "../include/kraken-math.h"
|
||||||
|
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
namespace kraken {
|
||||||
|
|
||||||
|
void Matrix2::init() {
|
||||||
|
// Default constructor - Initialize with an identity matrix
|
||||||
|
static const float IDENTITY_MATRIX[] = {
|
||||||
|
1.0, 0.0,
|
||||||
|
0.0, 1.0
|
||||||
|
};
|
||||||
|
memcpy(c, IDENTITY_MATRIX, sizeof(float) * 4);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
void Matrix2::init(float *pMat) {
|
||||||
|
memcpy(c, pMat, sizeof(float) * 4);
|
||||||
|
}
|
||||||
|
|
||||||
|
void Matrix2::init(const Vector2 &new_axis_x, const Vector2 &new_axis_y)
|
||||||
|
{
|
||||||
|
c[0] = new_axis_x.x; c[1] = new_axis_x.y;
|
||||||
|
c[2] = new_axis_y.x; c[3] = new_axis_y.y;
|
||||||
|
}
|
||||||
|
|
||||||
|
void Matrix2::init(const Matrix2 &m) {
|
||||||
|
memcpy(c, m.c, sizeof(float) * 4);
|
||||||
|
}
|
||||||
|
|
||||||
|
float *Matrix2::getPointer() {
|
||||||
|
return c;
|
||||||
|
}
|
||||||
|
|
||||||
|
float& Matrix2::operator[](unsigned i) {
|
||||||
|
return c[i];
|
||||||
|
}
|
||||||
|
|
||||||
|
float Matrix2::operator[](unsigned i) const {
|
||||||
|
return c[i];
|
||||||
|
}
|
||||||
|
|
||||||
|
// Overload comparison operator
|
||||||
|
bool Matrix2::operator==(const Matrix2 &m) const {
|
||||||
|
return memcmp(c, m.c, sizeof(float) * 4) == 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Overload compound multiply operator
|
||||||
|
Matrix2& Matrix2::operator*=(const Matrix2 &m) {
|
||||||
|
float temp[4];
|
||||||
|
|
||||||
|
int x,y;
|
||||||
|
|
||||||
|
for (x=0; x < 2; x++)
|
||||||
|
{
|
||||||
|
for(y=0; y < 2; y++)
|
||||||
|
{
|
||||||
|
temp[y + (x*2)] = (c[x*2] * m.c[y]) +
|
||||||
|
(c[x*2+1] * m.c[y+2]);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
memcpy(c, temp, sizeof(float) * 4);
|
||||||
|
return *this;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Overload multiply operator
|
||||||
|
Matrix2 Matrix2::operator*(const Matrix2 &m) const {
|
||||||
|
Matrix2 ret = *this;
|
||||||
|
ret *= m;
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Rotate a matrix by an angle on a X, Y, or Z axis */
|
||||||
|
void Matrix2::rotate(float angle) {
|
||||||
|
|
||||||
|
Matrix2 newMatrix; // Create new identity matrix
|
||||||
|
newMatrix.init();
|
||||||
|
newMatrix.c[0] = cos(angle);
|
||||||
|
newMatrix.c[1] = -sin(angle);
|
||||||
|
newMatrix.c[2] = -newMatrix.c[1];
|
||||||
|
newMatrix.c[3] = newMatrix.c[0];
|
||||||
|
|
||||||
|
*this *= newMatrix;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Scale matrix by separate x, y, and z amounts */
|
||||||
|
void Matrix2::scale(float x, float y) {
|
||||||
|
Matrix2 newMatrix; // Create new identity matrix
|
||||||
|
newMatrix.init();
|
||||||
|
|
||||||
|
newMatrix.c[0] = x;
|
||||||
|
newMatrix.c[3] = y;
|
||||||
|
|
||||||
|
*this *= newMatrix;
|
||||||
|
}
|
||||||
|
|
||||||
|
void Matrix2::scale(const Vector2 &v) {
|
||||||
|
scale(v.x, v.y);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Scale all dimensions equally */
|
||||||
|
void Matrix2::scale(float s) {
|
||||||
|
scale(s,s);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Replace matrix with its inverse */
|
||||||
|
bool Matrix2::invert() {
|
||||||
|
float det = 1.0f / (c[0] * c[3] + c[1] * c[2]);
|
||||||
|
if (det == 0) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
float invdet = 1.0f / det;
|
||||||
|
c[0] = c[3] * invdet;
|
||||||
|
c[1] = -c[1] * invdet;
|
||||||
|
c[2] = -c[2] * invdet;
|
||||||
|
c[3] = c[0] * invdet;
|
||||||
|
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
void Matrix2::transpose() {
|
||||||
|
float tmp = c[1];
|
||||||
|
c[1] = c[2];
|
||||||
|
c[2] = tmp;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Dot Product, returning Vector2 */
|
||||||
|
Vector2 Matrix2::Dot(const Matrix2 &m, const Vector2 &v) {
|
||||||
|
return Vector2::Create(
|
||||||
|
v.c[0] * m.c[0] + v.c[1] * m.c[2],
|
||||||
|
v.c[0] * m.c[1] + v.c[1] * m.c[3]
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
Matrix2 Matrix2::Invert(const Matrix2 &m)
|
||||||
|
{
|
||||||
|
Matrix2 matInvert = m;
|
||||||
|
matInvert.invert();
|
||||||
|
return matInvert;
|
||||||
|
}
|
||||||
|
|
||||||
|
Matrix2 Matrix2::Transpose(const Matrix2 &m)
|
||||||
|
{
|
||||||
|
Matrix2 matTranspose = m;
|
||||||
|
matTranspose.transpose();
|
||||||
|
return matTranspose;
|
||||||
|
}
|
||||||
|
|
||||||
|
Matrix2 Matrix2::Rotation(float angle)
|
||||||
|
{
|
||||||
|
Matrix2 m;
|
||||||
|
m.init();
|
||||||
|
m.rotate(angle);
|
||||||
|
return m;
|
||||||
|
}
|
||||||
|
|
||||||
|
Matrix2 Matrix2::Scaling(const Vector2 &v)
|
||||||
|
{
|
||||||
|
Matrix2 m;
|
||||||
|
m.init();
|
||||||
|
m.scale(v);
|
||||||
|
return m;
|
||||||
|
}
|
||||||
|
|
||||||
|
Matrix2 Matrix2::Identity()
|
||||||
|
{
|
||||||
|
Matrix2 m;
|
||||||
|
m.init();
|
||||||
|
return m;
|
||||||
|
}
|
||||||
|
|
||||||
|
} // namespace kraken
|
||||||
|
|
||||||
Reference in New Issue
Block a user