diff options
Diffstat (limited to 'src/jogl/classes')
3 files changed, 194 insertions, 191 deletions
diff --git a/src/jogl/classes/com/jogamp/opengl/math/geom/Frustum.java b/src/jogl/classes/com/jogamp/opengl/math/geom/Frustum.java new file mode 100644 index 000000000..7981903a9 --- /dev/null +++ b/src/jogl/classes/com/jogamp/opengl/math/geom/Frustum.java @@ -0,0 +1,174 @@ +/** + * Copyright 2010 JogAmp Community. 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 JogAmp Community ``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 JogAmp Community 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 JogAmp Community. + */ +package com.jogamp.opengl.math.geom; + +import com.jogamp.common.os.Platform; +import com.jogamp.opengl.math.FloatUtil; + +public class Frustum { + protected Plane[] planes = new Plane[6]; + protected float[] pmv; + + public Frustum(float[] pmv) { + this.pmv = pmv; + for (int i = 0; i < 6; ++i) { + planes[i] = new Plane(); + } + } + + public void setMatrix(float[] pmv) { + this.pmv = pmv; + } + + public final Plane[] getPlanes() { return planes; } + + public final float[] getPMV() { return pmv; } + + public class Plane { + public final float[] n = new float[3]; + public float d; + + public final float distanceTo(float x, float y, float z) { + return (n[0] * x) + (n[1] * y) + (n[2] * z) + d; + } + + @Override + public String toString() { + return "Plane[ [ " + n[0] + ", " + n[1] + ", " + n[2] + " ], " + d + "]"; + } + } + + private static final boolean quickClassify(Plane p, AABBox box) { + final float[] low = box.getLow(); + final float[] high = box.getHigh(); + + if (p.distanceTo(low[0], low[1], low[2]) > 0.0f) + return (true); + if (p.distanceTo(high[0], low[1], low[2]) > 0.0f) + return (true); + if (p.distanceTo(low[0], high[1], low[2]) > 0.0f) + return (true); + if (p.distanceTo(high[0], high[1], low[2]) > 0.0f) + return (true); + if (p.distanceTo(low[0], low[1], high[2]) > 0.0f) + return (true); + if (p.distanceTo(high[0], low[1], high[2]) > 0.0f) + return (true); + if (p.distanceTo(low[0], high[1], high[2]) > 0.0f) + return (true); + if (p.distanceTo(high[0], high[1], high[2]) > 0.0f) + return (true); + + return (false); + } + + /** + * Quick check to see if an orthogonal bounding box is inside the frustum + */ + public final boolean isInside(AABBox box) { + for (int i = 0; i < 6; ++i) { + if (!quickClassify(planes[i], box)) + return false; + } + // We make no attempt to determine whether it's fully inside or not. + return true; + } + + public void compute() { + // Left: [30+00, 31+01, 32+02, 33+03] + // comboMatrix.m[12] + comboMatrix.m[0]; + + planes[0].n[0] = pmv[12] + pmv[0]; + planes[0].n[1] = pmv[13] + pmv[1]; + planes[0].n[2] = pmv[14] + pmv[2]; + planes[0].d = pmv[15] + pmv[3]; + + // Right: [30-00, 31-01, 32-02, 33-03] + + planes[1].n[0] = pmv[12] - pmv[0]; + planes[1].n[1] = pmv[13] - pmv[1]; + planes[1].n[2] = pmv[14] - pmv[2]; + planes[1].d = pmv[15] - pmv[3]; + + // Bottom: [30+10, 31+11, 32+12, 33+13] + + planes[2].n[0] = pmv[12] + pmv[4]; + planes[2].n[1] = pmv[13] + pmv[5]; + planes[2].n[2] = pmv[14] + pmv[6]; + planes[2].d = pmv[15] + pmv[7]; + + // Top: [30-10, 31-11, 32-12, 33-13] + + planes[3].n[0] = pmv[12] - pmv[4]; + planes[3].n[1] = pmv[13] - pmv[5]; + planes[3].n[2] = pmv[14] - pmv[6]; + planes[3].d = pmv[15] - pmv[7]; + + // Far: [30-20, 31-21, 32-22, 33-23] + + planes[5].n[0] = pmv[12] - pmv[8]; + planes[5].n[1] = pmv[13] - pmv[9]; + planes[5].n[2] = pmv[14] - pmv[10]; + planes[5].d = pmv[15] - pmv[11]; + + // Near: [30+20, 31+21, 32+22, 33+23] + + planes[4].n[0] = pmv[12] + pmv[8]; + planes[4].n[1] = pmv[13] + pmv[9]; + planes[4].n[2] = pmv[14] + pmv[10]; + planes[4].d = pmv[15] + pmv[11]; + + + for (int i = 0; i < 6; ++i) { + final float[] p_n = planes[i].n; + final double invl = Math.sqrt(p_n[0] * p_n[0] + p_n[1] * p_n[1] + p_n[2] * p_n[2]); + + p_n[0] *= invl; + p_n[1] *= invl; + p_n[2] *= invl; + planes[i].d *= invl; + } + } + + public StringBuilder toString(StringBuilder sb) { + if( null == sb ) { + sb = new StringBuilder(); + } + sb.append("Frustum[ P*MV[").append(Platform.NEWLINE); + FloatUtil.matrixToString(sb, "p*mv", null, pmv, 0, 4, 4, false); + sb.append("], Planes[").append(planes[0]).append(", "); + sb.append(planes[1]).append(", ").append(planes[2]).append(", ").append(planes[3]).append(", ").append(planes[4]).append(", "); + sb.append(planes[5]).append("] ]"); + return sb; + } + + @Override + public String toString() { + return toString(null).toString(); + } +} diff --git a/src/jogl/classes/com/jogamp/opengl/util/Frustum2.java b/src/jogl/classes/com/jogamp/opengl/util/Frustum2.java deleted file mode 100644 index 0e115d1a2..000000000 --- a/src/jogl/classes/com/jogamp/opengl/util/Frustum2.java +++ /dev/null @@ -1,191 +0,0 @@ -package com.jogamp.opengl.util; - -import java.nio.FloatBuffer; - -// import org.openmali.spatial.bodies.Box; -// import org.openmali.spatial.bodies.Classifier; -// import org.openmali.vecmath2.Matrix4f; - -public class Frustum2 { - protected Plane[] planes = new Plane[6]; - protected PMVMatrix pmvMatrix; - protected FloatBuffer pmv = FloatBuffer.allocate(16); - protected int pmvOffset; - - public Frustum2(PMVMatrix matrix) { - setMatrix(matrix); - for (int i = 0; i < 6; ++i) { - planes[i] = new Plane(); - } - } - - public void setMatrix(PMVMatrix matrix) { - this.pmvMatrix = matrix; - // pmv = pmvMatrix.glGetPMvMatrixf(); - // pmvOffset = pmv.position(); - makePmvMatrix(); - } - - protected Matrix4f proj; - protected Matrix4f modl; - - private FloatBuffer b; - private int bOffset; - - private float f(int offset) { - return b.get(bOffset + offset); - } - - private Matrix4f getMatrix4f(FloatBuffer b) { - this.b = b; - bOffset = b.position(); - return new Matrix4f(f(0), f(1), f(2), f(3), f(4), f(5), f(6)/* 12 */, f(7), f(8), f(9), f(10), f(11), f(12), - f(13), f(14), f(15)); - } - - public void makePmvMatrix() { - getMatrix4f(pmvMatrix.glGetMvMatrixf()).mul(getMatrix4f(pmvMatrix.glGetPMatrixf())).writeToBuffer(pmv, true, - false); - } - - protected class Vector3f { - public float x; - public float y; - public float z; - - @Override - public String toString() { - return "{" + x + "," + y + "," + z + "}"; - } - } - - protected class Plane { - public Vector3f n = new Vector3f(); - public float d; - - public final float distanceTo(float x, float y, float z) { - return (n.x * x) + (n.y * y) + (n.z * z) + d; - } - - @Override - public String toString() { - return "Plane[" + n + ", " + d + "]"; - } - } - - protected float[] getMatrixFloat(FloatBuffer b) { - if (pmvMatrix.usesBackingArray()) { - return b.array(); - } else { - int p = b.position(); - float[] pm = new float[16]; - b.get(pm, p, 16); - b.position(p); - return pm; - } - } - - protected float m(int a) { - return pmv.get(a); - } - - private static final boolean quickClassify(Plane p, Box box) { - if (p.distanceTo(box.getLowerX(), box.getLowerY(), box.getLowerZ()) > 0.0f) - return (true); - if (p.distanceTo(box.getUpperX(), box.getLowerY(), box.getLowerZ()) > 0.0f) - return (true); - if (p.distanceTo(box.getLowerX(), box.getUpperY(), box.getLowerZ()) > 0.0f) - return (true); - if (p.distanceTo(box.getUpperX(), box.getUpperY(), box.getLowerZ()) > 0.0f) - return (true); - if (p.distanceTo(box.getLowerX(), box.getLowerY(), box.getUpperZ()) > 0.0f) - return (true); - if (p.distanceTo(box.getUpperX(), box.getLowerY(), box.getUpperZ()) > 0.0f) - return (true); - if (p.distanceTo(box.getLowerX(), box.getUpperY(), box.getUpperZ()) > 0.0f) - return (true); - if (p.distanceTo(box.getUpperX(), box.getUpperY(), box.getUpperZ()) > 0.0f) - return (true); - - return (false); - } - - /** - * Quick check to see if an orthogonal bounding box is inside the frustum - */ - public final Classifier.Classification quickClassify(Box box) { - for (int i = 0; i < 6; ++i) { - if (!quickClassify(planes[i], box)) - return (Classifier.Classification.OUTSIDE); - } - - // We make no attempt to determine whether it's fully inside or not. - return (Classifier.Classification.SPANNING); - } - - protected float[] mat = new float[16]; - - public void compute() { - // Left: [30+00, 31+01, 32+02, 33+03] - // comboMatrix.m[12] + comboMatrix.m[0]; - - planes[0].n.x = m(12) + m(0); - planes[0].n.y = m(13) + m(1); - planes[0].n.z = m(14) + m(2); - planes[0].d = m(15) + m(3); - - // Right: [30-00, 31-01, 32-02, 33-03] - - planes[1].n.x = m(12) - m(0); - planes[1].n.y = m(13) - m(1); - planes[1].n.z = m(14) - m(2); - planes[1].d = m(15) - m(3); - - // Bottom: [30+10, 31+11, 32+12, 33+13] - - planes[2].n.x = m(12) + m(4); - planes[2].n.y = m(13) + m(5); - planes[2].n.z = m(14) + m(6); - planes[2].d = m(15) + m(7); - - // Top: [30-10, 31-11, 32-12, 33-13] - - planes[3].n.x = m(12) - m(4); - planes[3].n.y = m(13) - m(5); - planes[3].n.z = m(14) - m(6); - planes[3].d = m(15) - m(7); - - // Far: [30-20, 31-21, 32-22, 33-23] - - planes[5].n.x = m(12) - m(8); - planes[5].n.y = m(13) - m(9); - planes[5].n.z = m(14) - m(10); - planes[5].d = m(15) - m(11); - - // Near: [30+20, 31+21, 32+22, 33+23] - - planes[4].n.x = m(12) + m(8); - planes[4].n.y = m(13) + m(9); - planes[4].n.z = m(14) + m(10); - planes[4].d = m(15) + m(11); - - - for (int i = 0; i < 6; ++i) { - double invl = Math.sqrt(planes[i].n.x * planes[i].n.x + planes[i].n.y * planes[i].n.y + planes[i].n.z - * planes[i].n.z); - - planes[i].n.x *= invl; - planes[i].n.y *= invl; - planes[i].n.z *= invl; - planes[i].d *= invl; - } - } - - @Override - public String toString() { - return "m[" + m(0) + "|" + m(1) + "|" + m(2) + "|" + m(3) + "|" + m(4) + "|" + m(5) + "|" + m(6) + "|" + m(7) - + "|" + m(8) + "|" + m(9) + "|" + m(10) + "|" + m(11) + "|" + m(12) + "|" + m(13) + "|" + m(14) + "|" - + m(15) + "]" + "Frustum2[" + planes[0] + ", " + planes[1] + ", " + planes[2] + ", " + planes[3] + ", " - + planes[4] + ", " + planes[5] + "]"; - } -} diff --git a/src/jogl/classes/com/jogamp/opengl/util/PMVMatrix.java b/src/jogl/classes/com/jogamp/opengl/util/PMVMatrix.java index 34971a9af..1628e0a8e 100644 --- a/src/jogl/classes/com/jogamp/opengl/util/PMVMatrix.java +++ b/src/jogl/classes/com/jogamp/opengl/util/PMVMatrix.java @@ -385,6 +385,26 @@ public class PMVMatrix implements GLMatrixFunc { public final FloatBuffer glGetPMvMatrixf() { return matrixPMv; } + + /** + * @param d a 4*4 float array to hold the pre-multiplied P*MV + * @param d_off offset of d + * @return the pre-multiplied P*MV, param d + */ + public float[] getPreMultipliedPMV(float[] d, int d_off) { + FloatUtil.multMatrixf(matrixP, matrixMv, d, d_off); + return d; + } + + /** + * @param d a 4*4 FloatBuffer to hold the premultiplied P*MV + * @param d_off offset of d + * @return the pre-multiplied P*MV, param d + */ + public FloatBuffer getPreMultipliedPMV(FloatBuffer d) { + FloatUtil.multMatrixf(matrixP, matrixMv, d); + return d; + } /** * Returns 3 matrices within one FloatBuffer: {@link #glGetPMatrixf() P}, {@link #glGetMvMatrixf() Mv} and {@link #glGetMviMatrixf() Mvi}. |