use crate::ellipsoid::{self, Ellipsoid};
use crate::grid::GridDefinition;
use smallvec::SmallVec;
#[derive(Debug, Clone)]
pub struct Datum {
pub ellipsoid: Ellipsoid,
pub to_wgs84: DatumToWgs84,
}
impl Datum {
pub fn is_wgs84_compatible(&self) -> bool {
matches!(self.to_wgs84, DatumToWgs84::Identity)
}
pub fn has_known_wgs84_transform(&self) -> bool {
!matches!(self.to_wgs84, DatumToWgs84::Unknown)
}
pub fn uses_grid_shift(&self) -> bool {
self.to_wgs84.uses_grid_shift()
}
pub fn helmert_to_wgs84(&self) -> Option<&HelmertParams> {
match &self.to_wgs84 {
DatumToWgs84::Helmert(params) => Some(params),
DatumToWgs84::Identity | DatumToWgs84::GridShift(_) | DatumToWgs84::Unknown => None,
}
}
pub fn approximate_helmert_to(&self, target: &Datum) -> Option<HelmertParams> {
if self.uses_grid_shift() || target.uses_grid_shift() {
return None;
}
if !self.has_known_wgs84_transform() || !target.has_known_wgs84_transform() {
return None;
}
let source_to_wgs84 = self
.helmert_to_wgs84()
.copied()
.unwrap_or_else(|| HelmertParams::translation(0.0, 0.0, 0.0));
let wgs84_to_target = target
.helmert_to_wgs84()
.map(HelmertParams::inverse)
.unwrap_or_else(|| HelmertParams::translation(0.0, 0.0, 0.0));
Some(source_to_wgs84.compose_approx(&wgs84_to_target))
}
pub fn same_datum(&self, other: &Datum) -> bool {
let same_ellipsoid = (self.ellipsoid.a - other.ellipsoid.a).abs() < 1e-6
&& (self.ellipsoid.f - other.ellipsoid.f).abs() < 1e-12;
match (&self.to_wgs84, &other.to_wgs84) {
(DatumToWgs84::Identity, DatumToWgs84::Identity) => same_ellipsoid,
(DatumToWgs84::Helmert(a), DatumToWgs84::Helmert(b)) => {
same_ellipsoid && a.approx_eq(b)
}
(DatumToWgs84::GridShift(a), DatumToWgs84::GridShift(b)) => same_ellipsoid && a == b,
(DatumToWgs84::Unknown, DatumToWgs84::Unknown) => false,
_ => false,
}
}
}
#[derive(Debug, Clone, PartialEq)]
pub enum DatumToWgs84 {
Identity,
Helmert(HelmertParams),
GridShift(Box<DatumGridShift>),
Unknown,
}
impl DatumToWgs84 {
pub fn uses_grid_shift(&self) -> bool {
matches!(self, DatumToWgs84::GridShift(shift) if shift.uses_grid_shift())
}
}
#[derive(Debug, Clone, PartialEq)]
pub struct DatumGridShift {
entries: SmallVec<[DatumGridShiftEntry; 4]>,
}
impl DatumGridShift {
pub fn new(entries: SmallVec<[DatumGridShiftEntry; 4]>) -> Self {
Self { entries }
}
pub fn from_vec(entries: Vec<DatumGridShiftEntry>) -> Self {
Self {
entries: SmallVec::from_vec(entries),
}
}
pub fn entries(&self) -> &[DatumGridShiftEntry] {
&self.entries
}
pub fn uses_grid_shift(&self) -> bool {
self.entries
.iter()
.any(|entry| matches!(entry, DatumGridShiftEntry::Grid { .. }))
}
}
#[derive(Debug, Clone, PartialEq)]
pub enum DatumGridShiftEntry {
Grid {
definition: GridDefinition,
optional: bool,
},
Null,
}
#[derive(Debug, Clone, Copy, PartialEq)]
pub struct HelmertParams {
pub dx: f64,
pub dy: f64,
pub dz: f64,
pub rx: f64,
pub ry: f64,
pub rz: f64,
pub ds: f64,
}
impl HelmertParams {
pub const fn translation(dx: f64, dy: f64, dz: f64) -> Self {
Self {
dx,
dy,
dz,
rx: 0.0,
ry: 0.0,
rz: 0.0,
ds: 0.0,
}
}
pub fn inverse(&self) -> Self {
Self {
dx: -self.dx,
dy: -self.dy,
dz: -self.dz,
rx: -self.rx,
ry: -self.ry,
rz: -self.rz,
ds: -self.ds,
}
}
pub fn compose_approx(&self, next: &Self) -> Self {
Self {
dx: self.dx + next.dx,
dy: self.dy + next.dy,
dz: self.dz + next.dz,
rx: self.rx + next.rx,
ry: self.ry + next.ry,
rz: self.rz + next.rz,
ds: self.ds + next.ds,
}
}
fn approx_eq(&self, other: &Self) -> bool {
(self.dx - other.dx).abs() < 1e-6
&& (self.dy - other.dy).abs() < 1e-6
&& (self.dz - other.dz).abs() < 1e-6
&& (self.rx - other.rx).abs() < 1e-9
&& (self.ry - other.ry).abs() < 1e-9
&& (self.rz - other.rz).abs() < 1e-9
&& (self.ds - other.ds).abs() < 1e-9
}
}
pub const WGS84: Datum = Datum {
ellipsoid: ellipsoid::WGS84,
to_wgs84: DatumToWgs84::Identity,
};
pub const NAD83: Datum = Datum {
ellipsoid: ellipsoid::GRS80,
to_wgs84: DatumToWgs84::Identity,
};
pub const NAD27: Datum = Datum {
ellipsoid: ellipsoid::CLARKE1866,
to_wgs84: DatumToWgs84::Helmert(HelmertParams::translation(-8.0, 160.0, 176.0)),
};
pub const ETRS89: Datum = Datum {
ellipsoid: ellipsoid::GRS80,
to_wgs84: DatumToWgs84::Identity,
};
pub const OSGB36: Datum = Datum {
ellipsoid: ellipsoid::AIRY1830,
to_wgs84: DatumToWgs84::Helmert(HelmertParams {
dx: 446.448,
dy: -125.157,
dz: 542.060,
rx: 0.1502,
ry: 0.2470,
rz: 0.8421,
ds: -20.4894,
}),
};
pub const PULKOVO1942: Datum = Datum {
ellipsoid: ellipsoid::KRASSOWSKY,
to_wgs84: DatumToWgs84::Helmert(HelmertParams::translation(23.92, -141.27, -80.9)),
};
pub const ED50: Datum = Datum {
ellipsoid: ellipsoid::INTL1924,
to_wgs84: DatumToWgs84::Helmert(HelmertParams::translation(-87.0, -98.0, -121.0)),
};
pub const TOKYO: Datum = Datum {
ellipsoid: ellipsoid::BESSEL1841,
to_wgs84: DatumToWgs84::Helmert(HelmertParams::translation(-146.414, 507.337, 680.507)),
};
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn wgs84_is_wgs84_compatible() {
assert!(WGS84.is_wgs84_compatible());
assert!(NAD83.is_wgs84_compatible());
assert!(ETRS89.is_wgs84_compatible());
}
#[test]
fn nad27_is_not_wgs84_compatible() {
assert!(!NAD27.is_wgs84_compatible());
assert!(!OSGB36.is_wgs84_compatible());
}
#[test]
fn same_datum_identity() {
assert!(WGS84.same_datum(&WGS84));
assert!(NAD27.same_datum(&NAD27));
}
#[test]
fn different_datums() {
assert!(!WGS84.same_datum(&NAD27));
assert!(!NAD27.same_datum(&OSGB36));
}
#[test]
fn unknown_datums_are_not_collapsed_by_ellipsoid() {
let a = Datum {
ellipsoid: ellipsoid::WGS84,
to_wgs84: DatumToWgs84::Unknown,
};
let b = Datum {
ellipsoid: ellipsoid::WGS84,
to_wgs84: DatumToWgs84::Unknown,
};
assert!(!a.same_datum(&b));
}
#[test]
fn helmert_inverse_negates() {
let h = HelmertParams {
dx: 1.0,
dy: 2.0,
dz: 3.0,
rx: 0.1,
ry: 0.2,
rz: 0.3,
ds: 0.5,
};
let inv = h.inverse();
assert_eq!(inv.dx, -1.0);
assert_eq!(inv.rx, -0.1);
assert_eq!(inv.ds, -0.5);
}
}