mirror of
https://github.com/bilawalsidhu/gods-eye-view.git
synced 2026-11-16 08:12:24 +00:00
The camera port gains an optional followFrame() (capability followFrame): the frame the eye is placed in now, as a column-major 4x4 matrix to ECEF. Once a follow has framed the camera it is the follow's own frame (east-north-up, or the orbit frame an autodetect follow chose), under lookAt the target's east-north-up frame, otherwise the identity. setView places a world pose and keeps that frame. The Cesium port reads it from camera.transform, only when the capability is on; the stub from its own eye frame. A conformance check covers the world, lookAt and enu-follow frames, the offset in it, and setView keeping it. src/ui/shareFollow.js now reads the pose, the frame and the follow offset through the camera and frame ports: a shared offset is re-expressed in the follow's own frame as before, satellites included, and the eye is placed with setView at exact heading, pitch and roll, so a near-vertical view keeps its roll. placeFollowEye returns false on a camera that cannot say its frame. offsetFromHeadingPitchRange moves to src/geo/frames.js, shared with the stub.
116 lines
3.2 KiB
JavaScript
116 lines
3.2 KiB
JavaScript
/**
|
|
* @module geo/frames
|
|
* @description Rigid frames (unit axes and an origin, local to ECEF), the
|
|
* east-north-up frame at a point, rotation about an axis, and the offset a
|
|
* heading, pitch and range puts an eye at.
|
|
*/
|
|
import { geodeticSurfaceNormal } from './ellipsoid.js';
|
|
import {
|
|
EPSILON14,
|
|
PI_OVER_TWO,
|
|
add,
|
|
clamp,
|
|
clone,
|
|
cross,
|
|
dot,
|
|
equalsEpsilon,
|
|
negate,
|
|
normalize,
|
|
scale,
|
|
sub,
|
|
vec,
|
|
zeroToTwoPi,
|
|
} from './vector.js';
|
|
|
|
/**
|
|
* A rigid frame: unit axes `x`, `y`, `z` (columns) and an `origin`, mapping
|
|
* local coordinates to ECEF.
|
|
* @typedef {{x: object, y: object, z: object, origin: object}} Frame
|
|
*/
|
|
|
|
export const IDENTITY = Object.freeze({
|
|
x: Object.freeze(vec(1, 0, 0)),
|
|
y: Object.freeze(vec(0, 1, 0)),
|
|
z: Object.freeze(vec(0, 0, 1)),
|
|
origin: Object.freeze(vec(0, 0, 0)),
|
|
});
|
|
|
|
export const isIdentity = (frame) =>
|
|
frame === IDENTITY ||
|
|
(frame.x.x === 1 &&
|
|
frame.y.y === 1 &&
|
|
frame.z.z === 1 &&
|
|
frame.x.y === 0 &&
|
|
frame.x.z === 0 &&
|
|
frame.y.x === 0 &&
|
|
frame.y.z === 0 &&
|
|
frame.z.x === 0 &&
|
|
frame.z.y === 0 &&
|
|
frame.origin.x === 0 &&
|
|
frame.origin.y === 0 &&
|
|
frame.origin.z === 0);
|
|
|
|
/** East-north-up at `origin`. */
|
|
export function eastNorthUp(origin) {
|
|
if (
|
|
equalsEpsilon(origin.x, 0, EPSILON14) &&
|
|
equalsEpsilon(origin.y, 0, EPSILON14)
|
|
) {
|
|
// At a pole: east is +y, north points away from the pole.
|
|
const sign = Math.sign(origin.z) || 1;
|
|
return {
|
|
x: vec(0, 1, 0),
|
|
y: vec(-sign, 0, 0),
|
|
z: vec(0, 0, sign),
|
|
origin: clone(origin),
|
|
};
|
|
}
|
|
const up = geodeticSurfaceNormal(origin);
|
|
const east = normalize(vec(-origin.y, origin.x, 0));
|
|
const north = cross(up, east);
|
|
return { x: east, y: north, z: up, origin: clone(origin) };
|
|
}
|
|
|
|
export const frameVector = (frame, v) =>
|
|
vec(
|
|
frame.x.x * v.x + frame.y.x * v.y + frame.z.x * v.z,
|
|
frame.x.y * v.x + frame.y.y * v.y + frame.z.y * v.z,
|
|
frame.x.z * v.x + frame.y.z * v.y + frame.z.z * v.z,
|
|
);
|
|
export const framePoint = (frame, p) =>
|
|
add(frameVector(frame, p), frame.origin);
|
|
export const inverseFrameVector = (frame, v) =>
|
|
vec(dot(frame.x, v), dot(frame.y, v), dot(frame.z, v));
|
|
export const inverseFramePoint = (frame, p) =>
|
|
inverseFrameVector(frame, sub(p, frame.origin));
|
|
|
|
/** Rotate `v` about unit `axis` by `angle` (right-handed). */
|
|
export function rotate(v, axis, angle) {
|
|
const c = Math.cos(angle);
|
|
const s = Math.sin(angle);
|
|
const d = dot(axis, v);
|
|
const k = cross(axis, v);
|
|
return vec(
|
|
v.x * c + k.x * s + axis.x * d * (1 - c),
|
|
v.y * c + k.y * s + axis.y * d * (1 - c),
|
|
v.z * c + k.z * s + axis.z * d * (1 - c),
|
|
);
|
|
}
|
|
|
|
/**
|
|
* The offset from a target a heading, pitch and range put the eye at, in
|
|
* the target's east-north-up frame: heading clockwise from north, pitch
|
|
* negative looking down (clamped to straight up or down), as `lookAt` takes
|
|
* them.
|
|
*/
|
|
export function offsetFromHeadingPitchRange(heading, pitch, range) {
|
|
const p = clamp(pitch, -PI_OVER_TWO, PI_OVER_TWO);
|
|
const h = zeroToTwoPi(heading) - PI_OVER_TWO;
|
|
const offset = rotate(
|
|
rotate(vec(1, 0, 0), vec(0, 1, 0), -p),
|
|
vec(0, 0, 1),
|
|
-h,
|
|
);
|
|
return scale(negate(offset), range);
|
|
}
|