// Перемещение камеры в право и в лево
private void setRightLeftPos(boolean right) {
Vec3 lengthPosLook = Vec3.vec3MinusVec3(pos1, look1);
Vec3 newLook = new Vec3(lengthPosLook);
double angle;
if (right) angle = -Math.PI / 2;
else angle = Math.PI / 2;
float x = newLook.x * (float) Math.cos(angle) - newLook.z * (float) Math.sin(angle);
newLook.y = 0;
float z = newLook.x * (float) Math.sin(angle) + newLook.z * (float) Math.cos(angle);
newLook.x = x;
newLook.z = z;
Vec3 normalSpeed = Vec3.vec3Normal(newLook);
normalSpeed = Vec3.Vec3MulVec3(normalSpeed, speedPos);
Vec3 vec = Vec3.vec3SummVec3(pos1, normalSpeed);
if ((vec.y >= limitYup) && blimitYup) normalSpeed.y = 0;
if ((vec.y <= limitYdown) && blimitYdown) {
normalSpeed.y = 0;
float posY = limitYdown - pos1.y;
pos1.y += posY;
look1.y += posY;
}
pos1 = Vec3.vec3SummVec3(pos1, normalSpeed);
look1 = Vec3.vec3SummVec3(look1, normalSpeed);
}
private void nextVec3Look() {
if (indexLook + 1 >= vectorLook.size()) return;
look1 = vectorLook.get(indexLook);
look2 = vectorLook.get(indexLook + 1);
Vec3 normalLook2 = Vec3.vec3MinusVec3(look1, look2);
normalLook2 = Vec3.vec3Normal(normalLook2);
normalLook2 = Vec3.Vec3MulVec3(normalLook2, speedLook);
vecNormalLook = new Vec3(normalLook2);
lengthVec3Look = Vec3.lengthVec3(vecNormalLook);
}
private void nextVec3Pos() {
if (indexPos + 1 >= vectorPos.size()) return;
pos1 = vectorPos.get(indexPos);
pos2 = vectorPos.get(indexPos + 1);
Vec3 normalPos2 = Vec3.vec3MinusVec3(pos1, pos2);
normalPos2 = Vec3.vec3Normal(normalPos2);
normalPos2 = Vec3.Vec3MulVec3(normalPos2, speedPos);
vecNormalPos = new Vec3(normalPos2);
lengthVec3Pos = Vec3.lengthVec3(vecNormalPos);
}
// Поворот камеры
private void setAngleLookUp(double angle, boolean right, boolean up) {
// Получаю вектор куда смотрит камера
Vec3 localLookCoord = Vec3.vec3MinusVec3(pos1, look1);
// Определители точки куда смотрит камера в сферической системе координат
float r, y, o, rXZ;
// Перевожу из декартовой системы координат в сферическую
r =
(float)
Math.sqrt(
localLookCoord.x * localLookCoord.x
+ localLookCoord.y * localLookCoord.y
+ localLookCoord.z * localLookCoord.z);
rXZ =
(float)
Math.sqrt(localLookCoord.x * localLookCoord.x + localLookCoord.z * localLookCoord.z);
y = (float) Math.acos(localLookCoord.x / rXZ);
o = (float) Math.asin(localLookCoord.y / r);
if (localLookCoord.z > 0) y = 2 * (float) Math.PI - y;
// Изменяем углы
if (up) {
o += angle;
if (o < 0.1 - Math.PI / 2) o = 0.1f - (float) Math.PI / 2;
if (o > Math.PI / 2 - 0.1) o = (float) Math.PI / 2 - 0.1f;
}
if (right) y += angle;
// Перевожу из сферической системы координат в декартовою
localLookCoord.x = (float) (r * Math.cos(o) * Math.cos(y));
localLookCoord.y = (float) (r * Math.sin(o));
localLookCoord.z = (float) -(r * Math.cos(o) * Math.sin(y));
localLookCoord = Vec3.vec3Normal(localLookCoord);
// Устанавливаю координаты направления взгляда камеры
look1 = Vec3.vec3SummVec3(pos1, localLookCoord);
}
// Перемещение камеры вперед и назад
private void goForwardBack(boolean forward) {
Vec3 lengthPosLook = Vec3.vec3MinusVec3(pos1, look1);
Vec3 normalSpeed = Vec3.vec3Normal(lengthPosLook);
normalSpeed = Vec3.Vec3MulVec3(normalSpeed, speedPos);
Vec3 vec = null;
if (forward) vec = Vec3.vec3SummVec3(pos1, normalSpeed);
else vec = Vec3.vec3MinusVec3(normalSpeed, pos1);
if ((vec.y >= limitYup) && blimitYup) normalSpeed.y = 0;
if ((vec.y <= limitYdown) && blimitYdown) {
normalSpeed.y = 0;
float posY = limitYdown - pos1.y;
pos1.y += posY;
look1.y += posY;
}
if (forward) {
pos1 = Vec3.vec3SummVec3(pos1, normalSpeed);
look1 = Vec3.vec3SummVec3(look1, normalSpeed);
} else {
pos1 = Vec3.vec3MinusVec3(normalSpeed, pos1);
look1 = Vec3.vec3MinusVec3(normalSpeed, look1);
}
}