mirror of
https://github.com/BlueMap-Minecraft/BlueMap.git
synced 2024-06-28 23:44:42 +02:00
Model-Rewrite: Add new mutable model class and deprectate old model classes
This commit is contained in:
Blue (Lukas Rieger)
parent
f05f12b86b
commit
4c23bd5add
|
|
@ -0,0 +1,287 @@
|
|||
/*
|
||||
* This file is part of BlueMap, licensed under the MIT License (MIT).
|
||||
*
|
||||
* Copyright (c) Blue (Lukas Rieger) <https://bluecolored.de>
|
||||
* Copyright (c) contributors
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
||||
* of this software and associated documentation files (the "Software"), to deal
|
||||
* in the Software without restriction, including without limitation the rights
|
||||
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
||||
* copies of the Software, and to permit persons to whom the Software is
|
||||
* furnished to do so, subject to the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice shall be included in
|
||||
* all copies or substantial portions of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
||||
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
||||
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
||||
* THE SOFTWARE.
|
||||
*/
|
||||
package de.bluecolored.bluemap.core.map.hires;
|
||||
|
||||
import com.flowpowered.math.TrigMath;
|
||||
|
||||
public class HiresTileModel {
|
||||
private static final double GROW_MULTIPLIER = 1.5;
|
||||
|
||||
// attributes per-vertex * per-face
|
||||
private static final int
|
||||
FI_POSITION = 3 * 3,
|
||||
FI_UV = 2 * 3,
|
||||
FI_AO = 3,
|
||||
FI_COLOR = 3 ,
|
||||
FI_SUNLIGHT = 1 ,
|
||||
FI_BLOCKLIGHT = 1 ,
|
||||
FI_MATERIAL_INDEX = 1 ;
|
||||
|
||||
private int capacity;
|
||||
private int size;
|
||||
|
||||
private double[] position;
|
||||
private float[] color, uv, ao;
|
||||
private byte[] sunlight, blocklight;
|
||||
private int[] materialIndex;
|
||||
|
||||
public HiresTileModel(int initialCapacity) {
|
||||
if (initialCapacity < 0) throw new IllegalArgumentException("initialCapacity is negative");
|
||||
setCapacity(initialCapacity);
|
||||
clear();
|
||||
}
|
||||
|
||||
public int size() {
|
||||
return size;
|
||||
}
|
||||
|
||||
public int add(int count) {
|
||||
ensureCapacity(count);
|
||||
return this.size += count;
|
||||
}
|
||||
|
||||
public void setPositions(
|
||||
int face,
|
||||
double x1, double y1, double z1,
|
||||
double x2, double y2, double z2,
|
||||
double x3, double y3, double z3
|
||||
){
|
||||
int index = face * FI_POSITION;
|
||||
|
||||
position[index ] = x1;
|
||||
position[index + 1] = y1;
|
||||
position[index + 2] = z1;
|
||||
|
||||
position[index + 3 ] = x2;
|
||||
position[index + 3 + 1] = y2;
|
||||
position[index + 3 + 2] = z2;
|
||||
|
||||
position[index + 6 ] = x3;
|
||||
position[index + 6 + 1] = y3;
|
||||
position[index + 6 + 2] = z3;
|
||||
}
|
||||
|
||||
public void setUvs(
|
||||
int face,
|
||||
float u1, float v1,
|
||||
float u2, float v2,
|
||||
float u3, float v3
|
||||
){
|
||||
int index = face * FI_UV;
|
||||
|
||||
uv[index ] = u1;
|
||||
uv[index + 1] = v1;
|
||||
|
||||
uv[index + 2 ] = u2;
|
||||
uv[index + 2 + 1] = v2;
|
||||
|
||||
uv[index + 4 ] = u3;
|
||||
uv[index + 4 + 1] = v3;
|
||||
}
|
||||
|
||||
public void setAOs(
|
||||
int face,
|
||||
float ao1, float ao2, float ao3
|
||||
) {
|
||||
int index = face * FI_AO;
|
||||
|
||||
ao[index ] = ao1;
|
||||
ao[index + 1] = ao2;
|
||||
ao[index + 2] = ao3;
|
||||
}
|
||||
|
||||
public void setColor(
|
||||
int face,
|
||||
float r, float g, float b
|
||||
){
|
||||
int index = face * FI_COLOR;
|
||||
|
||||
color[index ] = r;
|
||||
color[index + 1] = g;
|
||||
color[index + 2] = b;
|
||||
}
|
||||
|
||||
public void setSunlight(int face, int sl) {
|
||||
sunlight[face * FI_SUNLIGHT] = (byte) sl;
|
||||
}
|
||||
|
||||
public void setBlocklight(int face, int bl) {
|
||||
blocklight[face * FI_BLOCKLIGHT] = (byte) bl;
|
||||
}
|
||||
|
||||
public void setMaterialIndex(int face, int m) {
|
||||
materialIndex[face * FI_MATERIAL_INDEX] = m;
|
||||
}
|
||||
|
||||
public void rotate(
|
||||
int start, int count,
|
||||
float angle, float axisX, float axisY, float axisZ
|
||||
) {
|
||||
|
||||
// create quaternion
|
||||
double halfAngle = Math.toRadians(angle) * 0.5;
|
||||
double q = TrigMath.sin(halfAngle) / Math.sqrt(axisX * axisX + axisY * axisY + axisZ * axisZ);
|
||||
|
||||
double //quaternion
|
||||
qx = axisX * q,
|
||||
qy = axisY * q,
|
||||
qz = axisZ * q,
|
||||
qw = TrigMath.cos(halfAngle),
|
||||
qLength = Math.sqrt(qx * qx + qy * qy + qz * qz + qw * qw);
|
||||
|
||||
// normalize quaternion
|
||||
qx /= qLength;
|
||||
qy /= qLength;
|
||||
qz /= qLength;
|
||||
qw /= qLength;
|
||||
|
||||
rotateWithQuaternion(start, count, qx, qy, qz, qw);
|
||||
}
|
||||
|
||||
public void rotate(
|
||||
int start, int count,
|
||||
float pitch, float yaw, float roll
|
||||
) {
|
||||
|
||||
double
|
||||
halfYaw = Math.toRadians(yaw) * 0.5,
|
||||
qy1 = TrigMath.sin(halfYaw),
|
||||
qw1 = TrigMath.cos(halfYaw),
|
||||
|
||||
halfPitch = Math.toRadians(pitch) * 0.5,
|
||||
qx2 = TrigMath.sin(halfPitch),
|
||||
qw2 = TrigMath.cos(halfPitch),
|
||||
|
||||
halfRoll = Math.toRadians(roll) * 0.5,
|
||||
qz3 = TrigMath.sin(halfRoll),
|
||||
qw3 = TrigMath.cos(halfRoll);
|
||||
|
||||
// multiply 1 with 2
|
||||
double
|
||||
qxA = qw1 * qx2,
|
||||
qyA = qy1 * qw2,
|
||||
qzA = - qy1 * qx2,
|
||||
qwA = qw1 * qw2;
|
||||
|
||||
// multiply with 3
|
||||
double
|
||||
qx = qxA * qw3 + qyA * qz3,
|
||||
qy = qyA * qw3 - qxA * qz3,
|
||||
qz = qwA * qz3 + qzA * qw3,
|
||||
qw = qwA * qw3 - qzA * qz3;
|
||||
|
||||
rotateWithQuaternion(start, count, qx, qy, qz, qw);
|
||||
}
|
||||
|
||||
private void rotateWithQuaternion(
|
||||
int start, int count,
|
||||
double qx, double qy, double qz, double qw
|
||||
) {
|
||||
double x, y, z, px, py, pz, pw;
|
||||
int end = start + count, index;
|
||||
for (int face = start; face < end; face++) {
|
||||
index = face * FI_COLOR;
|
||||
|
||||
x = position[index ];
|
||||
y = position[index + 1];
|
||||
z = position[index + 2];
|
||||
|
||||
px = qw * x + qy * z - qz * y;
|
||||
py = qw * y + qz * x - qx * z;
|
||||
pz = qw * z + qx * y - qy * x;
|
||||
pw = -qx * x - qy * y - qz * z;
|
||||
|
||||
position[index ] = pw * -qx + px * qw - py * qz + pz * qy;
|
||||
position[index + 1] = pw * -qy + py * qw - pz * qx + px * qz;
|
||||
position[index + 2] = pw * -qz + pz * qw - px * qy + py * qx;
|
||||
}
|
||||
}
|
||||
|
||||
public void scale(
|
||||
int start, int count,
|
||||
float scale
|
||||
) {
|
||||
int startIndex = start * FI_POSITION;
|
||||
int endIndex = count * FI_POSITION + startIndex;
|
||||
|
||||
for (int i = startIndex; i < endIndex; i++)
|
||||
position[i] *= scale;
|
||||
}
|
||||
|
||||
public void translate(
|
||||
int start, int count,
|
||||
double dx, double dy, double dz
|
||||
) {
|
||||
int end = start + count, index;
|
||||
for (int face = start; face < end; face++) {
|
||||
index = face * FI_COLOR;
|
||||
for (int i = 0; i < 3; i++) {
|
||||
position[index ] += dx;
|
||||
position[index + 1] += dy;
|
||||
position[index + 2] += dz;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
public void clear() {
|
||||
this.size = 0;
|
||||
}
|
||||
|
||||
private void ensureCapacity(int count) {
|
||||
if (size + count > capacity){
|
||||
double[] _position = position;
|
||||
float[] _color = color, _uv = uv, _ao = ao;
|
||||
byte[] _sunlight = sunlight, _blocklight = blocklight;
|
||||
int[] _materialIndex = materialIndex;
|
||||
|
||||
int newCapacity = (int) (capacity * GROW_MULTIPLIER) + count;
|
||||
setCapacity(newCapacity);
|
||||
|
||||
System.arraycopy(_position, 0, position, 0, size * FI_POSITION);
|
||||
System.arraycopy(_uv, 0, uv, 0, size * FI_UV);
|
||||
System.arraycopy(_ao, 0, ao, 0, size * FI_AO);
|
||||
|
||||
System.arraycopy(_color, 0, color, 0, size * FI_COLOR);
|
||||
System.arraycopy(_sunlight, 0, sunlight, 0, size * FI_SUNLIGHT);
|
||||
System.arraycopy(_blocklight, 0, blocklight, 0, size * FI_BLOCKLIGHT);
|
||||
System.arraycopy(_materialIndex, 0, materialIndex, 0, size * FI_MATERIAL_INDEX);
|
||||
}
|
||||
}
|
||||
|
||||
private void setCapacity(int capacity) {
|
||||
this.capacity = capacity;
|
||||
|
||||
// attributes capacity * per-vertex * per-face
|
||||
position = new double [capacity * FI_POSITION];
|
||||
uv = new float [capacity * FI_UV];
|
||||
ao = new float [capacity * FI_AO];
|
||||
|
||||
color = new float [capacity * FI_COLOR];
|
||||
sunlight = new byte [capacity * FI_SUNLIGHT];
|
||||
blocklight = new byte [capacity * FI_BLOCKLIGHT];
|
||||
materialIndex = new int [capacity * FI_MATERIAL_INDEX];
|
||||
}
|
||||
|
||||
}
|
||||
|
|
@ -27,6 +27,7 @@
|
|||
import com.flowpowered.math.vector.Vector2f;
|
||||
import com.flowpowered.math.vector.Vector3f;
|
||||
|
||||
@Deprecated
|
||||
public class ExtendedFace extends Face {
|
||||
|
||||
private float ao1 = 1f, ao2 = 1f, ao3 = 1f; // ao
|
||||
|
|
|
|||
|
|
@ -27,6 +27,7 @@
|
|||
import de.bluecolored.bluemap.core.threejs.BufferAttribute;
|
||||
import de.bluecolored.bluemap.core.threejs.BufferGeometry;
|
||||
|
||||
@Deprecated
|
||||
public class ExtendedModel extends Model<ExtendedFace> {
|
||||
|
||||
@Override
|
||||
|
|
|
|||
|
|
@ -30,6 +30,7 @@
|
|||
import com.flowpowered.math.vector.Vector3f;
|
||||
import de.bluecolored.bluemap.core.util.MathUtils;
|
||||
|
||||
@Deprecated
|
||||
public class Face {
|
||||
|
||||
private final VectorM3f p1, p2, p3; // points
|
||||
|
|
|
|||
|
|
@ -0,0 +1,128 @@
|
|||
/*
|
||||
* This file is part of BlueMap, licensed under the MIT License (MIT).
|
||||
*
|
||||
* Copyright (c) Blue (Lukas Rieger) <https://bluecolored.de>
|
||||
* Copyright (c) contributors
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
||||
* of this software and associated documentation files (the "Software"), to deal
|
||||
* in the Software without restriction, including without limitation the rights
|
||||
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
||||
* copies of the Software, and to permit persons to whom the Software is
|
||||
* furnished to do so, subject to the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice shall be included in
|
||||
* all copies or substantial portions of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
||||
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
||||
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
||||
* THE SOFTWARE.
|
||||
*/
|
||||
package de.bluecolored.bluemap.core.model;
|
||||
|
||||
public class HiresTileModel extends TileModel {
|
||||
|
||||
// attributes per-vertex * per-face
|
||||
private static final int
|
||||
FI_UV = 2 * 3,
|
||||
FI_AO = 3,
|
||||
FI_COLOR = 3 ,
|
||||
FI_SUNLIGHT = 1 ,
|
||||
FI_BLOCKLIGHT = 1 ,
|
||||
FI_MATERIAL_INDEX = 1 ;
|
||||
|
||||
private float[] color, uv, ao;
|
||||
private byte[] sunlight, blocklight;
|
||||
private int[] materialIndex;
|
||||
|
||||
public HiresTileModel(int initialCapacity) {
|
||||
super(initialCapacity);
|
||||
}
|
||||
|
||||
public void setUvs(
|
||||
int face,
|
||||
float u1, float v1,
|
||||
float u2, float v2,
|
||||
float u3, float v3
|
||||
){
|
||||
int index = face * FI_UV;
|
||||
|
||||
uv[index ] = u1;
|
||||
uv[index + 1] = v1;
|
||||
|
||||
uv[index + 2 ] = u2;
|
||||
uv[index + 2 + 1] = v2;
|
||||
|
||||
uv[index + 4 ] = u3;
|
||||
uv[index + 4 + 1] = v3;
|
||||
}
|
||||
|
||||
public void setAOs(
|
||||
int face,
|
||||
float ao1, float ao2, float ao3
|
||||
) {
|
||||
int index = face * FI_AO;
|
||||
|
||||
ao[index ] = ao1;
|
||||
ao[index + 1] = ao2;
|
||||
ao[index + 2] = ao3;
|
||||
}
|
||||
|
||||
public void setColor(
|
||||
int face,
|
||||
float r, float g, float b
|
||||
){
|
||||
int index = face * FI_COLOR;
|
||||
|
||||
color[index ] = r;
|
||||
color[index + 1] = g;
|
||||
color[index + 2] = b;
|
||||
}
|
||||
|
||||
public void setSunlight(int face, int sl) {
|
||||
sunlight[face * FI_SUNLIGHT] = (byte) sl;
|
||||
}
|
||||
|
||||
public void setBlocklight(int face, int bl) {
|
||||
blocklight[face * FI_BLOCKLIGHT] = (byte) bl;
|
||||
}
|
||||
|
||||
public void setMaterialIndex(int face, int m) {
|
||||
materialIndex[face * FI_MATERIAL_INDEX] = m;
|
||||
}
|
||||
|
||||
protected void grow(int count) {
|
||||
float[] _color = color, _uv = uv, _ao = ao;
|
||||
byte[] _sunlight = sunlight, _blocklight = blocklight;
|
||||
int[] _materialIndex = materialIndex;
|
||||
|
||||
super.grow(count);
|
||||
|
||||
int size = size();
|
||||
System.arraycopy(_uv, 0, uv, 0, size * FI_UV);
|
||||
System.arraycopy(_ao, 0, ao, 0, size * FI_AO);
|
||||
|
||||
System.arraycopy(_color, 0, color, 0, size * FI_COLOR);
|
||||
System.arraycopy(_sunlight, 0, sunlight, 0, size * FI_SUNLIGHT);
|
||||
System.arraycopy(_blocklight, 0, blocklight, 0, size * FI_BLOCKLIGHT);
|
||||
System.arraycopy(_materialIndex, 0, materialIndex, 0, size * FI_MATERIAL_INDEX);
|
||||
}
|
||||
|
||||
protected void setCapacity(int capacity) {
|
||||
super.setCapacity(capacity);
|
||||
|
||||
// attributes capacity * per-vertex * per-face
|
||||
uv = new float [capacity * FI_UV];
|
||||
ao = new float [capacity * FI_AO];
|
||||
|
||||
color = new float [capacity * FI_COLOR];
|
||||
sunlight = new byte [capacity * FI_SUNLIGHT];
|
||||
blocklight = new byte [capacity * FI_BLOCKLIGHT];
|
||||
materialIndex = new int [capacity * FI_MATERIAL_INDEX];
|
||||
}
|
||||
|
||||
}
|
||||
|
|
@ -26,6 +26,7 @@
|
|||
|
||||
import com.flowpowered.math.matrix.Matrix3f;
|
||||
|
||||
@Deprecated
|
||||
public class MatrixM3f {
|
||||
|
||||
public float m00, m01, m02;
|
||||
|
|
|
|||
|
|
@ -24,17 +24,17 @@
|
|||
*/
|
||||
package de.bluecolored.bluemap.core.model;
|
||||
|
||||
import java.util.ArrayList;
|
||||
import java.util.List;
|
||||
|
||||
import com.flowpowered.math.imaginary.Quaternionf;
|
||||
import com.flowpowered.math.matrix.Matrix3f;
|
||||
import com.flowpowered.math.vector.Vector2f;
|
||||
import com.flowpowered.math.vector.Vector3f;
|
||||
|
||||
import de.bluecolored.bluemap.core.threejs.BufferGeometry;
|
||||
import de.bluecolored.bluemap.core.threejs.MaterialGroup;
|
||||
|
||||
import java.util.ArrayList;
|
||||
import java.util.List;
|
||||
|
||||
@Deprecated
|
||||
public class Model<T extends Face> {
|
||||
|
||||
private List<T> faces;
|
||||
|
|
|
|||
|
|
@ -0,0 +1,208 @@
|
|||
/*
|
||||
* This file is part of BlueMap, licensed under the MIT License (MIT).
|
||||
*
|
||||
* Copyright (c) Blue (Lukas Rieger) <https://bluecolored.de>
|
||||
* Copyright (c) contributors
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
||||
* of this software and associated documentation files (the "Software"), to deal
|
||||
* in the Software without restriction, including without limitation the rights
|
||||
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
||||
* copies of the Software, and to permit persons to whom the Software is
|
||||
* furnished to do so, subject to the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice shall be included in
|
||||
* all copies or substantial portions of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
||||
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
||||
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
||||
* THE SOFTWARE.
|
||||
*/
|
||||
package de.bluecolored.bluemap.core.model;
|
||||
|
||||
import com.flowpowered.math.TrigMath;
|
||||
|
||||
public abstract class TileModel {
|
||||
private static final double GROW_MULTIPLIER = 1.5;
|
||||
|
||||
private static final int FI_POSITION = 3 * 3;
|
||||
private double[] position;
|
||||
|
||||
private int capacity;
|
||||
private int size;
|
||||
|
||||
public TileModel(int initialCapacity) {
|
||||
if (initialCapacity < 0) throw new IllegalArgumentException("initialCapacity is negative");
|
||||
setCapacity(initialCapacity);
|
||||
clear();
|
||||
}
|
||||
|
||||
public int size() {
|
||||
return size;
|
||||
}
|
||||
|
||||
public int add(int count) {
|
||||
ensureCapacity(count);
|
||||
return this.size += count;
|
||||
}
|
||||
|
||||
public void setPositions(
|
||||
int face,
|
||||
double x1, double y1, double z1,
|
||||
double x2, double y2, double z2,
|
||||
double x3, double y3, double z3
|
||||
){
|
||||
int index = face * FI_POSITION;
|
||||
|
||||
position[index ] = x1;
|
||||
position[index + 1] = y1;
|
||||
position[index + 2] = z1;
|
||||
|
||||
position[index + 3 ] = x2;
|
||||
position[index + 3 + 1] = y2;
|
||||
position[index + 3 + 2] = z2;
|
||||
|
||||
position[index + 6 ] = x3;
|
||||
position[index + 6 + 1] = y3;
|
||||
position[index + 6 + 2] = z3;
|
||||
}
|
||||
|
||||
public void rotate(
|
||||
int start, int count,
|
||||
float angle, float axisX, float axisY, float axisZ
|
||||
) {
|
||||
|
||||
// create quaternion
|
||||
double halfAngle = Math.toRadians(angle) * 0.5;
|
||||
double q = TrigMath.sin(halfAngle) / Math.sqrt(axisX * axisX + axisY * axisY + axisZ * axisZ);
|
||||
|
||||
double //quaternion
|
||||
qx = axisX * q,
|
||||
qy = axisY * q,
|
||||
qz = axisZ * q,
|
||||
qw = TrigMath.cos(halfAngle),
|
||||
qLength = Math.sqrt(qx * qx + qy * qy + qz * qz + qw * qw);
|
||||
|
||||
// normalize quaternion
|
||||
qx /= qLength;
|
||||
qy /= qLength;
|
||||
qz /= qLength;
|
||||
qw /= qLength;
|
||||
|
||||
rotateWithQuaternion(start, count, qx, qy, qz, qw);
|
||||
}
|
||||
|
||||
public void rotate(
|
||||
int start, int count,
|
||||
float pitch, float yaw, float roll
|
||||
) {
|
||||
|
||||
double
|
||||
halfYaw = Math.toRadians(yaw) * 0.5,
|
||||
qy1 = TrigMath.sin(halfYaw),
|
||||
qw1 = TrigMath.cos(halfYaw),
|
||||
|
||||
halfPitch = Math.toRadians(pitch) * 0.5,
|
||||
qx2 = TrigMath.sin(halfPitch),
|
||||
qw2 = TrigMath.cos(halfPitch),
|
||||
|
||||
halfRoll = Math.toRadians(roll) * 0.5,
|
||||
qz3 = TrigMath.sin(halfRoll),
|
||||
qw3 = TrigMath.cos(halfRoll);
|
||||
|
||||
// multiply 1 with 2
|
||||
double
|
||||
qxA = qw1 * qx2,
|
||||
qyA = qy1 * qw2,
|
||||
qzA = - qy1 * qx2,
|
||||
qwA = qw1 * qw2;
|
||||
|
||||
// multiply with 3
|
||||
double
|
||||
qx = qxA * qw3 + qyA * qz3,
|
||||
qy = qyA * qw3 - qxA * qz3,
|
||||
qz = qwA * qz3 + qzA * qw3,
|
||||
qw = qwA * qw3 - qzA * qz3;
|
||||
|
||||
rotateWithQuaternion(start, count, qx, qy, qz, qw);
|
||||
}
|
||||
|
||||
private void rotateWithQuaternion(
|
||||
int start, int count,
|
||||
double qx, double qy, double qz, double qw
|
||||
) {
|
||||
double x, y, z, px, py, pz, pw;
|
||||
int end = start + count, index;
|
||||
for (int face = start; face < end; face++) {
|
||||
index = face * FI_POSITION;
|
||||
|
||||
x = position[index ];
|
||||
y = position[index + 1];
|
||||
z = position[index + 2];
|
||||
|
||||
px = qw * x + qy * z - qz * y;
|
||||
py = qw * y + qz * x - qx * z;
|
||||
pz = qw * z + qx * y - qy * x;
|
||||
pw = -qx * x - qy * y - qz * z;
|
||||
|
||||
position[index ] = pw * -qx + px * qw - py * qz + pz * qy;
|
||||
position[index + 1] = pw * -qy + py * qw - pz * qx + px * qz;
|
||||
position[index + 2] = pw * -qz + pz * qw - px * qy + py * qx;
|
||||
}
|
||||
}
|
||||
|
||||
public void scale(
|
||||
int start, int count,
|
||||
float scale
|
||||
) {
|
||||
int startIndex = start * FI_POSITION;
|
||||
int endIndex = count * FI_POSITION + startIndex;
|
||||
|
||||
for (int i = startIndex; i < endIndex; i++)
|
||||
position[i] *= scale;
|
||||
}
|
||||
|
||||
public void translate(
|
||||
int start, int count,
|
||||
double dx, double dy, double dz
|
||||
) {
|
||||
int end = start + count, index;
|
||||
for (int face = start; face < end; face++) {
|
||||
index = face * FI_POSITION;
|
||||
for (int i = 0; i < 3; i++) {
|
||||
position[index ] += dx;
|
||||
position[index + 1] += dy;
|
||||
position[index + 2] += dz;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
public void clear() {
|
||||
this.size = 0;
|
||||
}
|
||||
|
||||
protected void grow(int count) {
|
||||
double[] _position = position;
|
||||
|
||||
int newCapacity = (int) (capacity * GROW_MULTIPLIER) + count;
|
||||
setCapacity(newCapacity);
|
||||
|
||||
System.arraycopy(_position, 0, position, 0, size * FI_POSITION);
|
||||
}
|
||||
|
||||
private void ensureCapacity(int count) {
|
||||
if (size + count > capacity){
|
||||
grow(count);
|
||||
}
|
||||
}
|
||||
|
||||
protected void setCapacity(int capacity) {
|
||||
this.capacity = capacity;
|
||||
position = new double [capacity * FI_POSITION];
|
||||
}
|
||||
|
||||
}
|
||||
|
|
@ -28,6 +28,7 @@
|
|||
import com.flowpowered.math.imaginary.Quaternionf;
|
||||
import com.flowpowered.math.vector.Vector3f;
|
||||
|
||||
@Deprecated
|
||||
public class VectorM3f {
|
||||
|
||||
public float x, y, z;
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user