UNPKG

node-red-contrib-tak-registration

Version:

A Node-RED node to register to TAK and to help wrap files as datapackages to send to TAK

79 lines (73 loc) 3.11 kB
import Coordinate from '../geom/Coordinate' import Double from '../../../../java/lang/Double' import DD from '../math/DD' export default class CGAlgorithmsDD { static orientationIndex(p1, p2, q) { const index = CGAlgorithmsDD.orientationIndexFilter(p1, p2, q) if (index <= 1) return index const dx1 = DD.valueOf(p2.x).selfAdd(-p1.x) const dy1 = DD.valueOf(p2.y).selfAdd(-p1.y) const dx2 = DD.valueOf(q.x).selfAdd(-p2.x) const dy2 = DD.valueOf(q.y).selfAdd(-p2.y) return dx1.selfMultiply(dy2).selfSubtract(dy1.selfMultiply(dx2)).signum() } static signOfDet2x2() { if (arguments[3] instanceof DD && (arguments[2] instanceof DD && (arguments[0] instanceof DD && arguments[1] instanceof DD))) { const x1 = arguments[0], y1 = arguments[1], x2 = arguments[2], y2 = arguments[3] const det = x1.multiply(y2).selfSubtract(y1.multiply(x2)) return det.signum() } else if (typeof arguments[3] === 'number' && (typeof arguments[2] === 'number' && (typeof arguments[0] === 'number' && typeof arguments[1] === 'number'))) { const dx1 = arguments[0], dy1 = arguments[1], dx2 = arguments[2], dy2 = arguments[3] const x1 = DD.valueOf(dx1) const y1 = DD.valueOf(dy1) const x2 = DD.valueOf(dx2) const y2 = DD.valueOf(dy2) const det = x1.multiply(y2).selfSubtract(y1.multiply(x2)) return det.signum() } } static intersection(p1, p2, q1, q2) { const px = new DD(p1.y).selfSubtract(p2.y) const py = new DD(p2.x).selfSubtract(p1.x) const pw = new DD(p1.x).selfMultiply(p2.y).selfSubtract(new DD(p2.x).selfMultiply(p1.y)) const qx = new DD(q1.y).selfSubtract(q2.y) const qy = new DD(q2.x).selfSubtract(q1.x) const qw = new DD(q1.x).selfMultiply(q2.y).selfSubtract(new DD(q2.x).selfMultiply(q1.y)) const x = py.multiply(qw).selfSubtract(qy.multiply(pw)) const y = qx.multiply(pw).selfSubtract(px.multiply(qw)) const w = px.multiply(qy).selfSubtract(qx.multiply(py)) const xInt = x.selfDivide(w).doubleValue() const yInt = y.selfDivide(w).doubleValue() if (Double.isNaN(xInt) || (Double.isInfinite(xInt) || Double.isNaN(yInt)) || Double.isInfinite(yInt)) return null return new Coordinate(xInt, yInt) } static orientationIndexFilter(pa, pb, pc) { let detsum = null const detleft = (pa.x - pc.x) * (pb.y - pc.y) const detright = (pa.y - pc.y) * (pb.x - pc.x) const det = detleft - detright if (detleft > 0.0) if (detright <= 0.0) return CGAlgorithmsDD.signum(det) else detsum = detleft + detright else if (detleft < 0.0) if (detright >= 0.0) return CGAlgorithmsDD.signum(det) else detsum = -detleft - detright else return CGAlgorithmsDD.signum(det) const errbound = CGAlgorithmsDD.DP_SAFE_EPSILON * detsum if (det >= errbound || -det >= errbound) return CGAlgorithmsDD.signum(det) return 2 } static signum(x) { if (x > 0) return 1 if (x < 0) return -1 return 0 } } CGAlgorithmsDD.DP_SAFE_EPSILON = 1e-15