#!/usr/bin/env python3
"""Zajednički koordinatni sustavi kampanje "prikazi i tlocrti".

Dva lokalna sustava s istim ishodištem (45,8187 N, 16,0185 E):

ENU-N (nominalni)  x = (lon - lon0) * cos(lat0) * 111320, y = (lat - lat0) * 110574.
                   U njemu su zapisani site.json, program.json, kote i rasteri terena
                   (stanje 13.11.2026.). Nije prava metrika: stvarne duljine su veće
                   oko 0,17 % po x i 0,52 % po y.
ENU-M (metrički)   lokalna poprečna Mercatorova projekcija na elipsoidu GRS80 s
                   ishodištem u istoj točki i mjerilom 1. x istok, y sjever, u pravim
                   metrima. U njemu se grade 3D scena, kamere, tlocrti u mjerilu i
                   računaju površine.

Sve skripte koje crtaju, mjere ili renderiraju trebaju podatke iz ENU-N prevesti u
ENU-M ovim modulom. Datoteke nose oznaku sustava u meta.koordinate; bez oznake vrijedi
ENU-N.
"""
from __future__ import annotations

import math

LAT0 = 45.8187
LON0 = 16.0185
N_KX = math.cos(math.radians(LAT0)) * 111320.0  # m po stupnju dužine, nominalno
N_KY = 110574.0  # m po stupnju širine, nominalno

_PROJ = None
_HTRS = None


def _proj():
    global _PROJ
    if _PROJ is None:
        from pyproj import Transformer

        crs_m = f"+proj=tmerc +lat_0={LAT0} +lon_0={LON0} +k=1 +x_0=0 +y_0=0 +ellps=GRS80 +units=m +no_defs"
        _PROJ = (
            Transformer.from_crs("EPSG:4326", crs_m, always_xy=True),
            Transformer.from_crs(crs_m, "EPSG:4326", always_xy=True),
        )
    return _PROJ


def _htrs():
    global _HTRS
    if _HTRS is None:
        from pyproj import Transformer

        _HTRS = (
            Transformer.from_crs("EPSG:4326", "EPSG:3765", always_xy=True),
            Transformer.from_crs("EPSG:3765", "EPSG:4326", always_xy=True),
        )
    return _HTRS


# --- ENU-N <-> zemljopisne koordinate ---------------------------------------

def n_iz_lonlat(lon, lat):
    return (lon - LON0) * N_KX, (lat - LAT0) * N_KY


def lonlat_iz_n(x, y):
    return LON0 + x / N_KX, LAT0 + y / N_KY


# --- ENU-M <-> zemljopisne koordinate ---------------------------------------

def m_iz_lonlat(lon, lat):
    return _proj()[0].transform(lon, lat)


def lonlat_iz_m(x, y):
    return _proj()[1].transform(x, y)


# --- ENU-N <-> ENU-M ---------------------------------------------------------

def m_iz_n(x, y):
    lon, lat = lonlat_iz_n(x, y)
    return m_iz_lonlat(lon, lat)


def n_iz_m(x, y):
    lon, lat = lonlat_iz_m(x, y)
    return n_iz_lonlat(lon, lat)


def poligon_m_iz_n(tocke):
    return [list(m_iz_n(p[0], p[1])) for p in tocke]


# --- HTRS96/TM (EPSG:3765) ---------------------------------------------------

def m_iz_htrs(e, n):
    lon, lat = _htrs()[1].transform(e, n)
    return m_iz_lonlat(lon, lat)


def htrs_iz_m(x, y):
    lon, lat = lonlat_iz_m(x, y)
    return _htrs()[0].transform(lon, lat)


def mjerilo_n_prema_m():
    """Omjer metričke i nominalne duljine u ishodištu (po x i po y)."""
    d = 100.0
    x1, _ = m_iz_n(d, 0.0)
    _, y1 = m_iz_n(0.0, d)
    return x1 / d, y1 / d


def _samoprovjera():
    sx, sy = mjerilo_n_prema_m()
    assert abs(sx - 1.0017) < 3e-4, sx
    assert abs(sy - 1.0052) < 3e-4, sy
    # povratni put
    for p in [(0.0, 0.0), (-428.0, 30.0), (731.0, 180.0), (-5500.0, 8900.0)]:
        q = n_iz_m(*m_iz_n(*p))
        assert math.hypot(q[0] - p[0], q[1] - p[1]) < 1e-4, (p, q)
    # bušotine iz geotehničkog elaborata GEL-33/2025, tablica 1 (HTRS96/TM):
    # međusobne udaljenosti u ENU-M moraju odgovarati udaljenostima u HTRS96/TM
    # do mjerila projekcije (HTRS96/TM ima mjerilo 0,9999 na srednjem meridijanu).
    b = {
        "B1": (462283.70, 5075575.82),
        "B3": (462643.57, 5075671.49),
        "B4": (462435.39, 5075191.13),
    }
    m = {k: m_iz_htrs(*v) for k, v in b.items()}
    for a, c in [("B1", "B3"), ("B1", "B4"), ("B3", "B4")]:
        d_h = math.dist(b[a], b[c])
        d_m = math.dist(m[a], m[c])
        assert abs(d_m / d_h - 1.0) < 2e-4, (a, c, d_h, d_m)
    return sx, sy


if __name__ == "__main__":
    sx, sy = _samoprovjera()
    print(f"ENU-M / ENU-N u ishodištu: x {sx:.5f}, y {sy:.5f}")
    print("stadion (45,8188 N, 16,0179 E) u ENU-M:", [round(v, 2) for v in m_iz_lonlat(16.0179, 45.8188)])
    print("samoprovjera prošla")
