Esempio n. 1
0
		LPZ inverse3d(XYZ xyz)
		{
			LPZ lpz;
			lpz.lam = lpz.phi = lpz.z = 0;

			// Local lat, lon using radius
			double pxyz0 = xyz.y * a / rcurv;
			double pxyz1 = xyz.x * a / rcurv;
			double pxyz2 = xyz.z;

			double temp0, temp1, temp2;
			if (sph.pj_Convert_Geodetic_To_Geocentric(pxyz0, pxyz1, pxyz2, out temp0, out temp1, out temp2) != 0) { Proj.pj_ctx_set_errno(ctx, -20); return lpz; }

			// Apply rotation
			pxyz0 = transMat[0] * temp0 + transMat[1] * temp1 + transMat[2] * temp2;
			pxyz1 = transMat[3] * temp0 + transMat[4] * temp1 + transMat[5] * temp2;
			pxyz2 = transMat[6] * temp0 + transMat[7] * temp1 + transMat[8] * temp2;

			// Apply offset
			pxyz0 += xyzoff[0];
			pxyz1 += xyzoff[1];
			pxyz2 += xyzoff[2];

			// Convert geocentric coordinates to lat lon
			elp_0.pj_Convert_Geocentric_To_Geodetic(pxyz0, pxyz1, pxyz2, out temp0, out temp1, out temp2);

			lpz.lam = temp1;
			lpz.phi = temp0;
			lpz.z = temp2;

			//printf("INVERSE: \n");
			//printf("XYZ: %f %f %f \n", xyz.x, xyz.y, xyz.z);
			//printf("LPZ: %f %f %f \n", lpz.lam, lpz.phi, lpz.z);
			return lpz;
		}
Esempio n. 2
0
		// general inverse projection

		// inverse projection entry
		public static LPZ pj_inv3d(XYZ xyz, PJ P)
		{
			LPZ lpz;

			// can't do as much preliminary checking as with forward
			if (xyz.x == Libc.HUGE_VAL || xyz.y == Libc.HUGE_VAL || xyz.z == Libc.HUGE_VAL)
			{
				lpz.lam = lpz.phi = lpz.z = Libc.HUGE_VAL;
				pj_ctx_set_errno(P.ctx, -15);
				return lpz;
			}

			Libc.errno = pj_errno = 0;
			P.ctx.last_errno = 0;

			xyz.x = (xyz.x * P.to_meter - P.x0) * P.ra; // descale and de-offset
			xyz.y = (xyz.y * P.to_meter - P.y0) * P.ra;
			// z is not scaled since that is handled by vto_meter before we get here

			// Check for NULL pointer
			if (P.inv3d != null)
			{
				lpz = P.inv3d(xyz); // inverse project
				if (P.ctx.last_errno != 0) lpz.lam = lpz.phi = lpz.z = Libc.HUGE_VAL;
				else
				{
					lpz.lam += P.lam0; // reduce from del lp.lam
					if (!P.over) lpz.lam = adjlon(lpz.lam); // adjust longitude to CM

					// This maybe redundant and never used
					if (P.geoc && Math.Abs(Math.Abs(lpz.phi) - HALFPI) > EPS12) lpz.phi = Math.Atan(P.one_es * Math.Tan(lpz.phi));
				}
			}
			else
			{
				lpz.lam = lpz.phi = lpz.z = Libc.HUGE_VAL;
			}

			return lpz;
		}