Added gluProject & gluUnproject (not tested)
This commit is contained in:
parent
4732089913
commit
ea2f9a3910
|
@ -1,6 +1,7 @@
|
|||
package org.lwjgl.opengl.glu;
|
||||
|
||||
import java.nio.FloatBuffer;
|
||||
import java.nio.IntBuffer;
|
||||
|
||||
import org.lwjgl.opengl.GL11;
|
||||
|
||||
|
@ -14,27 +15,135 @@ import org.lwjgl.opengl.GL11;
|
|||
public class Project extends Util implements GLUConstants {
|
||||
|
||||
private static FloatBuffer matrix = createFloatBuffer(16);
|
||||
private static FloatBuffer finalMatrix = createFloatBuffer(16);
|
||||
|
||||
/**
|
||||
* Make m an identity matrix
|
||||
* Make matrix an identity matrix
|
||||
*/
|
||||
private static void __gluMakeIdentityf() {
|
||||
matrix.put(0 + 4 * 0, 1);
|
||||
matrix.put(0 + 4 * 1, 0);
|
||||
matrix.put(0 + 4 * 2, 0);
|
||||
matrix.put(0 + 4 * 3, 0);
|
||||
matrix.put(1 + 4 * 0, 0);
|
||||
matrix.put(1 + 4 * 1, 1);
|
||||
matrix.put(1 + 4 * 2, 0);
|
||||
matrix.put(1 + 4 * 3, 0);
|
||||
matrix.put(2 + 4 * 0, 0);
|
||||
matrix.put(2 + 4 * 1, 0);
|
||||
matrix.put(2 + 4 * 2, 1);
|
||||
matrix.put(2 + 4 * 3, 0);
|
||||
matrix.put(3 + 4 * 0, 0);
|
||||
matrix.put(3 + 4 * 1, 0);
|
||||
matrix.put(3 + 4 * 2, 0);
|
||||
matrix.put(3 + 4 * 3, 1);
|
||||
private static void __gluMakeIdentityf(FloatBuffer m) {
|
||||
m.put(0 + 4 * 0, 1);
|
||||
m.put(0 + 4 * 1, 0);
|
||||
m.put(0 + 4 * 2, 0);
|
||||
m.put(0 + 4 * 3, 0);
|
||||
m.put(1 + 4 * 0, 0);
|
||||
m.put(1 + 4 * 1, 1);
|
||||
m.put(1 + 4 * 2, 0);
|
||||
m.put(1 + 4 * 3, 0);
|
||||
m.put(2 + 4 * 0, 0);
|
||||
m.put(2 + 4 * 1, 0);
|
||||
m.put(2 + 4 * 2, 1);
|
||||
m.put(2 + 4 * 3, 0);
|
||||
m.put(3 + 4 * 0, 0);
|
||||
m.put(3 + 4 * 1, 0);
|
||||
m.put(3 + 4 * 2, 0);
|
||||
m.put(3 + 4 * 3, 1);
|
||||
}
|
||||
|
||||
/**
|
||||
* Method __gluMultMatrixVecf
|
||||
* @param finalMatrix
|
||||
* @param in
|
||||
* @param out
|
||||
*/
|
||||
private static void __gluMultMatrixVecf(FloatBuffer finalMatrix, float[] in, float[] out) {
|
||||
|
||||
for (int i=0; i<4; i++) {
|
||||
out[i] =
|
||||
in[0] * finalMatrix.get(0*4+i) +
|
||||
in[1] * finalMatrix.get(1*4+i) +
|
||||
in[2] * finalMatrix.get(2*4+i) +
|
||||
in[3] * finalMatrix.get(3*4+i);
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* @param finalMatrix
|
||||
* @param finalMatrix2
|
||||
* @return
|
||||
*/
|
||||
private static boolean __gluInvertMatrixf(FloatBuffer src, FloatBuffer inverse) {
|
||||
int i, j, k, swap;
|
||||
float t;
|
||||
float[][] temp = new float[4][4];
|
||||
|
||||
for (i=0; i<4; i++) {
|
||||
for (j=0; j<4; j++) {
|
||||
temp[i][j] = src.get(i*4+j);
|
||||
}
|
||||
}
|
||||
__gluMakeIdentityf(inverse);
|
||||
|
||||
for (i = 0; i < 4; i++) {
|
||||
/*
|
||||
** Look for largest element in column
|
||||
*/
|
||||
swap = i;
|
||||
for (j = i + 1; j < 4; j++) {
|
||||
/*if (fabs(temp[j][i]) > fabs(temp[i][i])) {
|
||||
swap = j;
|
||||
}*/
|
||||
if (Math.abs(temp[j][i]) > Math.abs(temp[i][i])) {
|
||||
swap = j;
|
||||
}
|
||||
}
|
||||
|
||||
if (swap != i) {
|
||||
/*
|
||||
** Swap rows.
|
||||
*/
|
||||
for (k = 0; k < 4; k++) {
|
||||
t = temp[i][k];
|
||||
temp[i][k] = temp[swap][k];
|
||||
temp[swap][k] = t;
|
||||
|
||||
t = inverse.get(i*4+k);
|
||||
inverse.put(i*4+k, inverse.get(swap*4+k));
|
||||
inverse.put(swap*4+k,t);
|
||||
}
|
||||
}
|
||||
|
||||
if (temp[i][i] == 0) {
|
||||
/*
|
||||
** No non-zero pivot. The matrix is singular, which shouldn't
|
||||
** happen. This means the user gave us a bad matrix.
|
||||
*/
|
||||
return false;
|
||||
}
|
||||
|
||||
t = temp[i][i];
|
||||
for (k = 0; k < 4; k++) {
|
||||
temp[i][k] /= t;
|
||||
inverse.put(i*4+k, inverse.get(i*4+k) / t);
|
||||
}
|
||||
for (j = 0; j < 4; j++) {
|
||||
if (j != i) {
|
||||
t = temp[j][i];
|
||||
for (k = 0; k < 4; k++) {
|
||||
temp[j][k] -= temp[i][k]*t;
|
||||
inverse.put(j*4+k, inverse.get(j*4+k) - inverse.get(i*4+k)*t);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
return true;
|
||||
}
|
||||
|
||||
/**
|
||||
* @param modelMatrix
|
||||
* @param projMatrix
|
||||
* @param finalMatrix
|
||||
*/
|
||||
private static void __gluMultMatricesf(FloatBuffer a, FloatBuffer b, FloatBuffer r) {
|
||||
|
||||
for (int i = 0; i < 4; i++) {
|
||||
for (int j = 0; j < 4; j++) {
|
||||
r.put(i*4+j,
|
||||
a.get(i*4+0)*b.get(0*4+j) +
|
||||
a.get(i*4+1)*b.get(1*4+j) +
|
||||
a.get(i*4+2)*b.get(2*4+j) +
|
||||
a.get(i*4+3)*b.get(3*4+j));
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
|
@ -55,7 +164,7 @@ public class Project extends Util implements GLUConstants {
|
|||
}
|
||||
cotangent = (float) Math.cos(radians) / sine;
|
||||
|
||||
__gluMakeIdentityf();
|
||||
__gluMakeIdentityf(matrix);
|
||||
|
||||
matrix.put(0 * 4 + 0, cotangent / aspect);
|
||||
matrix.put(1 * 4 + 1, cotangent);
|
||||
|
@ -112,7 +221,7 @@ public class Project extends Util implements GLUConstants {
|
|||
/* Recompute up as: up = side x forward */
|
||||
cross(side, forward, up);
|
||||
|
||||
__gluMakeIdentityf();
|
||||
__gluMakeIdentityf(matrix);
|
||||
matrix.put(0 * 4 + 0, side[0]);
|
||||
matrix.put(1 * 4 + 0, side[1]);
|
||||
matrix.put(2 * 4 + 0, side[2]);
|
||||
|
@ -129,6 +238,103 @@ public class Project extends Util implements GLUConstants {
|
|||
GL11.glTranslatef(-eyex, -eyey, -eyez);
|
||||
}
|
||||
|
||||
/**
|
||||
* Method gluProject
|
||||
* @param objx
|
||||
* @param objy
|
||||
* @param objz
|
||||
* @param modelMatrix
|
||||
* @param projMatrix
|
||||
* @param viewport
|
||||
* @param winx
|
||||
* @param winy
|
||||
* @param winz
|
||||
* @return
|
||||
*/
|
||||
public static boolean gluProject(float objx, float objy, float objz,
|
||||
FloatBuffer modelMatrix,
|
||||
FloatBuffer projMatrix,
|
||||
IntBuffer viewport,
|
||||
FloatBuffer winx, FloatBuffer winy, FloatBuffer winz)
|
||||
{
|
||||
float[] in = new float[4];
|
||||
float[] out = new float[4];
|
||||
|
||||
in[0]=objx;
|
||||
in[1]=objy;
|
||||
in[2]=objz;
|
||||
in[3]=1.0f;
|
||||
__gluMultMatrixVecf(modelMatrix, in, out);
|
||||
__gluMultMatrixVecf(projMatrix, out, in);
|
||||
if (in[3] == 0.0) return false;
|
||||
in[0] /= in[3];
|
||||
in[1] /= in[3];
|
||||
in[2] /= in[3];
|
||||
// Map x, y and z to range 0-1
|
||||
in[0] = in[0] * 0.5f + 0.5f;
|
||||
in[1] = in[1] * 0.5f + 0.5f;
|
||||
in[2] = in[2] * 0.5f + 0.5f;
|
||||
|
||||
// Map x,y to viewport
|
||||
in[0] = in[0] * viewport.get(2) + viewport.get(0);
|
||||
in[1] = in[1] * viewport.get(3) + viewport.get(1);
|
||||
|
||||
winx.put(0, in[0]);
|
||||
winy.put(0, in[1]);
|
||||
winz.put(0, in[2]);
|
||||
return true;
|
||||
}
|
||||
|
||||
/**
|
||||
* Method gluUnproject
|
||||
* @param winx
|
||||
* @param winy
|
||||
* @param winz
|
||||
* @param modelMatrix
|
||||
* @param projMatrix
|
||||
* @param viewport
|
||||
* @param objx
|
||||
* @param objy
|
||||
* @param objz
|
||||
* @return
|
||||
*/
|
||||
public static boolean gluUnProject(float winx, float winy, float winz,
|
||||
FloatBuffer modelMatrix,
|
||||
FloatBuffer projMatrix,
|
||||
IntBuffer viewport,
|
||||
FloatBuffer objx, FloatBuffer objy, FloatBuffer objz)
|
||||
{
|
||||
float[] in = new float[4];
|
||||
float[] out = new float[4];
|
||||
|
||||
__gluMultMatricesf(modelMatrix, projMatrix, finalMatrix);
|
||||
if (!__gluInvertMatrixf(finalMatrix, finalMatrix)) return false;
|
||||
|
||||
in[0]=winx;
|
||||
in[1]=winy;
|
||||
in[2]=winz;
|
||||
in[3]=1.0f;
|
||||
|
||||
// Map x and y from window coordinates
|
||||
in[0] = (in[0] - viewport.get(0)) / viewport.get(2);
|
||||
in[1] = (in[1] - viewport.get(1)) / viewport.get(3);
|
||||
|
||||
// Map to range -1 to 1
|
||||
in[0] = in[0] * 2 - 1;
|
||||
in[1] = in[1] * 2 - 1;
|
||||
in[2] = in[2] * 2 - 1;
|
||||
|
||||
__gluMultMatrixVecf(finalMatrix, in, out);
|
||||
if (out[3] == 0.0) return false;
|
||||
out[0] /= out[3];
|
||||
out[1] /= out[3];
|
||||
out[2] /= out[3];
|
||||
objx.put(0, out[0]);
|
||||
objy.put(0, out[1]);
|
||||
objz.put(0, out[2]);
|
||||
return true;
|
||||
}
|
||||
|
||||
/**
|
||||
* Method gluPickMatrix
|
||||
* @param x
|
||||
|
|
Loading…
Reference in New Issue