/// <inheritdoc />
protected override void OnInverse(double[] xy, double[] lp, int startIndex, int numPoints)
{
for (int i = startIndex; i < startIndex + numPoints; i++)
{
int phi = i * 2 + PHI;
int lam = i * 2 + LAMBDA;
int x = i * 2 + X;
int y = i * 2 + Y;
double cz1 = Math.Cos(Proj.Hypot(xy[y], xy[x] + _hz0));
double cz2 = Math.Cos(Proj.Hypot(xy[y], xy[x] - _hz0));
double s = cz1 + cz2;
double d = cz1 - cz2;
lp[lam] = -Math.Atan2(d, (s * _thz0));
lp[phi] = Proj.Aacos(Proj.Hypot(_thz0 * s, d) * _rhshz0);
if (xy[y] < 0)
{
lp[phi] = -lp[phi];
}
/* lam--phi now in system relative to P1--P2 base equator */
double sp = Math.Sin(lp[phi]);
double cp = Math.Cos(lp[phi]);
lp[phi] = Proj.Aasin(_sa * sp + _ca * cp * (s = Math.Cos(lp[lam] -= _lp)));
lp[lam] = Math.Atan2(cp * Math.Sin(lp[lam]), _sa * cp * s - _ca * sp) + _lamc;
}
}
/// <summary>
/// Initializes the transform using the parameters from the specified coordinate system information
/// </summary>
/// <param name="projInfo">A ProjectionInfo class contains all the standard and custom parameters needed to initialize this transform</param>
protected override void OnInit(ProjectionInfo projInfo)
{
double pp;
/* get control point locations */
double phi1 = projInfo.Phi1;
double lam1 = projInfo.Lam1;
double phi2 = projInfo.Phi2;
double lam2 = projInfo.Lam2;
if (phi1 == phi2 && lam1 == lam2)
{
throw new ProjectionException(-25);
}
Lam0 = Proj.Adjlon(0.5 * (lam1 + lam2));
_dlam2 = Proj.Adjlon(lam2 - lam1);
_cp1 = Math.Cos(phi1);
_cp2 = Math.Cos(phi2);
_sp1 = Math.Sin(phi1);
_sp2 = Math.Sin(phi2);
_cs = _cp1 * _sp2;
_sc = _sp1 * _cp2;
_ccs = _cp1 * _cp2 * Math.Sin(_dlam2);
_z02 = Proj.Aacos(_sp1 * _sp2 + _cp1 * _cp2 * Math.Cos(_dlam2));
_hz0 = .5 * _z02;
double a12 = Math.Atan2(_cp2 * Math.Sin(_dlam2),
_cp1 * _sp2 - _sp1 * _cp2 * Math.Cos(_dlam2));
_ca = Math.Cos(pp = Proj.Aasin(_cp1 * Math.Sin(a12)));
_sa = Math.Sin(pp);
_lp = Proj.Adjlon(Math.Atan2(_cp1 * Math.Cos(a12), _sp1) - _hz0);
_dlam2 *= .5;
_lamc = HALF_PI - Math.Atan2(Math.Sin(a12) * _sp1, Math.Cos(a12)) - _dlam2;
_thz0 = Math.Tan(_hz0);
_rhshz0 = .5 / Math.Sin(_hz0);
_r2Z0 = 0.5 / _z02;
_z02 *= _z02;
}
/// <inheritdoc />
protected override void OnForward(double[] lp, double[] xy, int startIndex, int numPoints)
{
for (int i = startIndex; i < startIndex + numPoints; i++)
{
int phi = i * 2 + PHI;
int lam = i * 2 + LAMBDA;
int x = i * 2 + X;
int y = i * 2 + Y;
double t, dl1, dl2;
double sp = Math.Sin(lp[phi]);
double cp = Math.Cos(lp[phi]);
double z1 = Proj.Aacos(_sp1 * sp + _cp1 * cp * Math.Cos(dl1 = lp[lam] + _dlam2));
double z2 = Proj.Aacos(_sp2 * sp + _cp2 * cp * Math.Cos(dl2 = lp[lam] - _dlam2));
z1 *= z1;
z2 *= z2;
xy[x] = _r2Z0 * (t = z1 - z2);
t = _z02 - t;
xy[y] = _r2Z0 * Proj.Asqrt(4 * _z02 * z2 - t * t);
if ((_ccs * sp - cp * (_cs * Math.Sin(dl1) - _sc * Math.Sin(dl2))) < 0)
{
xy[y] = -xy[y];
}
}
}
