blob: 63fc529ecb9ffdcbfebb41c17656376368a7c222 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
|
/* general forward projection */
#define PJ_LIB__
#include <projects.h>
#include <errno.h>
# define EPS 1.0e-12
XYZ /* forward projection entry */
pj_fwd3d(LPZ lpz, PJ *P) {
XYZ xyz;
double t;
/* check for forward and latitude or longitude overange */
if ((t = fabs(lpz.phi)-M_HALFPI) > EPS || fabs(lpz.lam) > 10.) {
xyz.x = xyz.y = xyz.z = HUGE_VAL;
pj_ctx_set_errno( P->ctx, -14);
} else { /* proceed with projection */
P->ctx->last_errno = 0;
pj_errno = 0;
errno = 0;
if (fabs(t) <= EPS)
lpz.phi = lpz.phi < 0. ? -M_HALFPI : M_HALFPI;
else if (P->geoc) /* Maybe redundant and never used. */
lpz.phi = atan(P->rone_es * tan(lpz.phi));
lpz.lam -= P->lam0; /* compute del lp.lam */
if (!P->over)
lpz.lam = adjlon(lpz.lam); /* adjust del longitude */
/* Check for NULL pointer */
if (P->fwd3d != NULL)
{
xyz = (*P->fwd3d)(lpz, P); /* project */
if ( P->ctx->last_errno )
xyz.x = xyz.y = xyz.z = HUGE_VAL;
/* adjust for major axis and easting/northings */
else {
xyz.x = P->fr_meter * (P->a * xyz.x + P->x0);
xyz.y = P->fr_meter * (P->a * xyz.y + P->y0);
/* z is not scaled since this handled by vto_meter outside */
}
}
else
{
xyz.x = xyz.y = xyz.z = HUGE_VAL;
}
}
return xyz;
}
|
