scummvm/math/glmath.cpp
2015-03-22 15:57:15 +01:00

99 lines
2.9 KiB
C++

/* ResidualVM - A 3D game interpreter
*
* ResidualVM is the legal property of its developers, whose names
* are too numerous to list here. Please refer to the COPYRIGHT
* file distributed with this source distribution.
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation; either version 2
* of the License, or (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
*
*/
#include "math/glmath.h"
namespace Math {
// function based on gluUnProject from Mesa 5.0 glu GPLv2+ licensed sources
bool gluMathUnProject(Vector3d win, const Matrix4 &mvpMatrix, const Common::Rect &viewport, Vector3d &obj) {
Matrix4 A;
Vector4d in, out;
in.x() = (win.x() - viewport.left) * 2 / viewport.width() - 1.0;
in.y() = (win.y() - viewport.top) * 2 / viewport.height() - 1.0;
in.z() = 2 * win.z() - 1.0;
in.w() = 1.0;
A = mvpMatrix;
A.inverse();
out = A.transform(in);
if (out.w() == 0.0)
return false;
obj.x() = out.x() / out.w();
obj.y() = out.y() / out.w();
obj.z() = out.z() / out.w();
return true;
}
// function based on gluPerspective from Mesa 5.0 glu GPLv2+ licensed sources
Matrix4 makePerspectiveMatrix(double fovy, double aspect, double zNear, double zFar) {
double xmin, xmax, ymin, ymax;
ymax = zNear * tan(fovy * M_PI / 360.0);
ymin = -ymax;
xmin = ymin * aspect;
xmax = ymax * aspect;
return makeFrustumMatrix(xmin, xmax, ymin, ymax, zNear, zFar);
}
Matrix4 makeFrustumMatrix(double left, double right, double bottom, double top, double zNear, double zFar) {
Matrix4 proj;
proj(0, 0) = (2.0f * zNear) / (right - left);
proj(1, 1) = (2.0f * zNear) / (top - bottom);
proj(2, 0) = (right + left) / (right - left);
proj(2, 1) = (top + bottom) / (top - bottom);
proj(2, 2) = -(zFar + zNear) / (zFar - zNear);
proj(2, 3) = -1.0f;
proj(3, 2) = -(2.0f * zFar * zNear) / (zFar - zNear);
proj(3, 3) = 0.0f;
return proj;
}
Matrix4 makeLookAtMatrix(const Vector3d &eye, const Vector3d &center, const Vector3d &up) {
Vector3d f = (center - eye).getNormalized();
Vector3d u = up.getNormalized();
Vector3d s = Vector3d::crossProduct(f, u).getNormalized();
u = Vector3d::crossProduct(s, f);
Math::Matrix4 look;
look(0, 0) = s.x();
look(1, 0) = s.y();
look(2, 0) = s.z();
look(0, 1) = u.x();
look(1, 1) = u.y();
look(2, 1) = u.z();
look(0, 2) = -f.x();
look(1, 2) = -f.y();
look(2, 2) = -f.z();
look(3, 3) = 1.0;
return look;
}
}