Debian Codegraph @

gctp/src/aziminv.c

raw
1 /*******************************************************************************
2 NAME AZIMUTHAL EQUIDISTANT
3
4 PURPOSE: Transforms input Easting and Northing to longitude and
5 latitude for the Azimuthal Equidistant projection. The
6 Easting and Northing must be in meters. The longitude
7 and latitude values will be returned in radians.
8
9 PROGRAMMER DATE
10 ---------- ----
11 T. Mittan Mar, 1993
12
13 ALGORITHM REFERENCES
14
15 1. Snyder, John P., "Map Projections--A Working Manual", U.S. Geological
16 Survey Professional Paper 1395 (Supersedes USGS Bulletin 1532), United
17 State Government Printing Office, Washington D.C., 1987.
18
19 2. Snyder, John P. and Voxland, Philip M., "An Album of Map Projections",
20 U.S. Geological Survey Professional Paper 1453 , United State Government
21 Printing Office, Washington D.C., 1989.
22 *******************************************************************************/
23 #include <stdio.h>
24 #include "cproj.h"
25
26 /* Variables common to all subroutines in this code file
27 -----------------------------------------------------*/
28 static double r_major; /* major axis */
29 static double lon_center; /* Center longitude (projection center) */
30 static double lat_origin; /* center latitude */
31 static double false_northing; /* y offset in meters */
32 static double false_easting; /* x offset in meters */
33 static double sin_p12; /* sin of center latitude */
34 static double cos_p12; /* cos of center latitude */
35
36 /* Initialize the Azimuthal projection
37 ----------------------------------*/
38 int aziminvint(
39 double r_maj, /* major axis */
40 double center_lon, /* center longitude */
41 double center_lat, /* center latitude */
42 double false_east, /* x offset in meters */
43 double false_north) /* y offset in meters */
44 {
45
46 /* Place parameters in static storage for common use
47 -------------------------------------------------*/
48 r_major = r_maj;
49 lon_center = center_lon;
50 lat_origin = center_lat;
51 false_northing = false_north;
52 false_easting = false_east;
53
54 tsincos(center_lat,&sin_p12,&cos_p12);
55
56 /* Report parameters to the user
57 -----------------------------*/
58 ptitle("AZIMUTHAL EQUIDISTANT");
59 radius(r_major);
60 cenlonmer(lon_center);
61 origin(lat_origin);
62 offsetp(false_easting,false_northing);
63 return(OK);
64 }
65
66
67 /* Azimuthal inverse equations--mapping x,y to lat/long
68 ---------------------------------------------------*/
69 int aziminv(
70 double x, /* (O) X projection coordinate */
71 double y, /* (O) Y projection coordinate */
72 double *lon, /* (I) Longitude */
73 double *lat) /* (I) Latitude */
74 {
75 double rh; /* height above ellipsoid */
76 double z; /* angle */
77 double sinz,cosz; /* sin of z and cos of z */
78 double con;
79
80 /* Inverse equations
81 -----------------*/
82 x -= false_easting;
83 y -= false_northing;
84 rh = sqrt(x * x + y * y);
85 if (rh > (2.0 * HALF_PI * r_major))
86 {
87 p_error("Input data error","azim-inv");
88 return(125);
89 }
90 z = rh / r_major;
91 tsincos(z,&sinz,&cosz);
92 *lon = lon_center;
93 if (fabs(rh) <= EPSLN)
94 {
95 *lat = lat_origin;
96 return(OK);
97 }
98 *lat = asinz(cosz * sin_p12 + (y * sinz * cos_p12) / rh);
99 con = fabs(lat_origin) - HALF_PI;
100 if (fabs(con) <= EPSLN)
101 {
102 if (lat_origin >= 0.0)
103 {
104 *lon = adjust_lon(lon_center + atan2(x , -y));
105 return(OK);
106 }
107 else
108 {
109 *lon = adjust_lon(lon_center - atan2(-x , y));
110 return(OK);
111 }
112 }
113 con = cosz - sin_p12 * sin(*lat);
114 if ((fabs(con) < EPSLN) && (fabs(x) < EPSLN))
115 return(OK);
116 *lon = adjust_lon(lon_center + atan2((x * sinz * cos_p12), (con * rh)));
117
118 return(OK);
119 }