#include <errno.h>
#include <math.h>

#include "proj.h"
#include "proj_internal.h"

PROJ_HEAD(gstmerc,
          "Gauss-Schreiber Transverse Mercator (aka Gauss-Laborde Reunion)")
"\n\tCyl, Sph&Ell\n\tlat_0= lon_0= k_0=";

namespace { // anonymous namespace
struct pj_gstmerc_data {
    double lamc;
    double phic;
    double c;
    double n1;
    double n2;
    double XS;
    double YS;
};
} // anonymous namespace

static PJ_XY gstmerc_s_forward(PJ_LP lp, PJ *P) { /* Spheroidal, forward */
    PJ_XY xy = {0.0, 0.0};
    struct pj_gstmerc_data *Q =
        static_cast<struct pj_gstmerc_data *>(P->opaque);
    double L, Ls, sinLs1, Ls1;

    L = Q->n1 * lp.lam;
    Ls = Q->c + Q->n1 * log(pj_tsfn(-lp.phi, -sin(lp.phi), P->e));
    sinLs1 = sin(L) / cosh(Ls);
    Ls1 = log(pj_tsfn(-asin(sinLs1), -sinLs1, 0.0));
    xy.x = (Q->XS + Q->n2 * Ls1) * P->ra;
    xy.y = (Q->YS + Q->n2 * atan(sinh(Ls) / cos(L))) * P->ra;

    return xy;
}

static PJ_LP gstmerc_s_inverse(PJ_XY xy, PJ *P) { /* Spheroidal, inverse */
    PJ_LP lp = {0.0, 0.0};
    struct pj_gstmerc_data *Q =
        static_cast<struct pj_gstmerc_data *>(P->opaque);
    double L, LC, sinC;

    L = atan(sinh((xy.x * P->a - Q->XS) / Q->n2) /
             cos((xy.y * P->a - Q->YS) / Q->n2));
    sinC = sin((xy.y * P->a - Q->YS) / Q->n2) /
           cosh((xy.x * P->a - Q->XS) / Q->n2);
    LC = log(pj_tsfn(-asin(sinC), -sinC, 0.0));
    lp.lam = L / Q->n1;
    lp.phi = -pj_phi2(P->ctx, exp((LC - Q->c) / Q->n1), P->e);

    return lp;
}

PJ *PJ_PROJECTION(gstmerc) {
    struct pj_gstmerc_data *Q = static_cast<struct pj_gstmerc_data *>(
        calloc(1, sizeof(struct pj_gstmerc_data)));
    if (nullptr == Q)
        return pj_default_destructor(P, PROJ_ERR_OTHER /*ENOMEM*/);
    P->opaque = Q;

    Q->lamc = P->lam0;
    Q->n1 = sqrt(1 + P->es * pow(cos(P->phi0), 4.0) / (1 - P->es));
    Q->phic = asin(sin(P->phi0) / Q->n1);
    Q->c = log(pj_tsfn(-Q->phic, -sin(P->phi0) / Q->n1, 0.0)) -
           Q->n1 * log(pj_tsfn(-P->phi0, -sin(P->phi0), P->e));
    Q->n2 = P->k0 * P->a * sqrt(1 - P->es) /
            (1 - P->es * sin(P->phi0) * sin(P->phi0));
    Q->XS = 0;
    Q->YS = -Q->n2 * Q->phic;

    P->inv = gstmerc_s_inverse;
    P->fwd = gstmerc_s_forward;

    return P;
}