File indexing completed on 2025-01-18 09:35:43
0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012
0013
0014
0015
0016
0017
0018
0019
0020
0021
0022
0023
0024
0025
0026
0027
0028
0029
0030
0031
0032
0033
0034
0035
0036
0037
0038
0039
0040 #ifndef BOOST_GEOMETRY_PROJECTIONS_LABRD_HPP
0041 #define BOOST_GEOMETRY_PROJECTIONS_LABRD_HPP
0042
0043 #include <boost/geometry/srs/projections/impl/base_static.hpp>
0044 #include <boost/geometry/srs/projections/impl/base_dynamic.hpp>
0045 #include <boost/geometry/srs/projections/impl/factory_entry.hpp>
0046 #include <boost/geometry/srs/projections/impl/pj_param.hpp>
0047 #include <boost/geometry/srs/projections/impl/projects.hpp>
0048
0049 namespace boost { namespace geometry
0050 {
0051
0052 namespace projections
0053 {
0054 #ifndef DOXYGEN_NO_DETAIL
0055 namespace detail { namespace labrd
0056 {
0057 static const double epsilon = 1.e-10;
0058
0059 template <typename T>
0060 struct par_labrd
0061 {
0062 T Az, kRg, p0s, A, C, Ca, Cb, Cc, Cd;
0063 };
0064
0065 template <typename T, typename Parameters>
0066 struct base_labrd_ellipsoid
0067 {
0068 par_labrd<T> m_proj_parm;
0069
0070
0071
0072 inline void fwd(Parameters const& par, T const& lp_lon, T const& lp_lat, T& xy_x, T& xy_y) const
0073 {
0074 static const T fourth_pi = detail::fourth_pi<T>();
0075
0076 T V1, V2, ps, sinps, cosps, sinps2, cosps2;
0077 T I1, I2, I3, I4, I5, I6, x2, y2, t;
0078
0079 V1 = this->m_proj_parm.A * log( tan(fourth_pi + .5 * lp_lat) );
0080 t = par.e * sin(lp_lat);
0081 V2 = .5 * par.e * this->m_proj_parm.A * log ((1. + t)/(1. - t));
0082 ps = 2. * (atan(exp(V1 - V2 + this->m_proj_parm.C)) - fourth_pi);
0083 I1 = ps - this->m_proj_parm.p0s;
0084 cosps = cos(ps); cosps2 = cosps * cosps;
0085 sinps = sin(ps); sinps2 = sinps * sinps;
0086 I4 = this->m_proj_parm.A * cosps;
0087 I2 = .5 * this->m_proj_parm.A * I4 * sinps;
0088 I3 = I2 * this->m_proj_parm.A * this->m_proj_parm.A * (5. * cosps2 - sinps2) / 12.;
0089 I6 = I4 * this->m_proj_parm.A * this->m_proj_parm.A;
0090 I5 = I6 * (cosps2 - sinps2) / 6.;
0091 I6 *= this->m_proj_parm.A * this->m_proj_parm.A *
0092 (5. * cosps2 * cosps2 + sinps2 * (sinps2 - 18. * cosps2)) / 120.;
0093 t = lp_lon * lp_lon;
0094 xy_x = this->m_proj_parm.kRg * lp_lon * (I4 + t * (I5 + t * I6));
0095 xy_y = this->m_proj_parm.kRg * (I1 + t * (I2 + t * I3));
0096 x2 = xy_x * xy_x;
0097 y2 = xy_y * xy_y;
0098 V1 = 3. * xy_x * y2 - xy_x * x2;
0099 V2 = xy_y * y2 - 3. * x2 * xy_y;
0100 xy_x += this->m_proj_parm.Ca * V1 + this->m_proj_parm.Cb * V2;
0101 xy_y += this->m_proj_parm.Ca * V2 - this->m_proj_parm.Cb * V1;
0102 }
0103
0104
0105
0106 inline void inv(Parameters const& par, T xy_x, T xy_y, T& lp_lon, T& lp_lat) const
0107 {
0108 static const T fourth_pi = detail::fourth_pi<T>();
0109
0110
0111
0112
0113 T x2, y2, V1, V2, V3, V4, t = 0.0, t2, ps, pe, tpe, s;
0114 T I7, I8, I9, I10, I11, d, Re;
0115 int i;
0116
0117 x2 = xy_x * xy_x;
0118 y2 = xy_y * xy_y;
0119 V1 = 3. * xy_x * y2 - xy_x * x2;
0120 V2 = xy_y * y2 - 3. * x2 * xy_y;
0121 V3 = xy_x * (5. * y2 * y2 + x2 * (-10. * y2 + x2 ));
0122 V4 = xy_y * (5. * x2 * x2 + y2 * (-10. * x2 + y2 ));
0123 xy_x += - this->m_proj_parm.Ca * V1 - this->m_proj_parm.Cb * V2 + this->m_proj_parm.Cc * V3 + this->m_proj_parm.Cd * V4;
0124 xy_y += this->m_proj_parm.Cb * V1 - this->m_proj_parm.Ca * V2 - this->m_proj_parm.Cd * V3 + this->m_proj_parm.Cc * V4;
0125 ps = this->m_proj_parm.p0s + xy_y / this->m_proj_parm.kRg;
0126 pe = ps + par.phi0 - this->m_proj_parm.p0s;
0127
0128 for ( i = 20; i; --i) {
0129 V1 = this->m_proj_parm.A * log(tan(fourth_pi + .5 * pe));
0130 tpe = par.e * sin(pe);
0131 V2 = .5 * par.e * this->m_proj_parm.A * log((1. + tpe)/(1. - tpe));
0132 t = ps - 2. * (atan(exp(V1 - V2 + this->m_proj_parm.C)) - fourth_pi);
0133 pe += t;
0134 if (fabs(t) < epsilon)
0135 break;
0136 }
0137
0138 t = par.e * sin(pe);
0139 t = 1. - t * t;
0140 Re = par.one_es / ( t * sqrt(t) );
0141 t = tan(ps);
0142 t2 = t * t;
0143 s = this->m_proj_parm.kRg * this->m_proj_parm.kRg;
0144 d = Re * par.k0 * this->m_proj_parm.kRg;
0145 I7 = t / (2. * d);
0146 I8 = t * (5. + 3. * t2) / (24. * d * s);
0147 d = cos(ps) * this->m_proj_parm.kRg * this->m_proj_parm.A;
0148 I9 = 1. / d;
0149 d *= s;
0150 I10 = (1. + 2. * t2) / (6. * d);
0151 I11 = (5. + t2 * (28. + 24. * t2)) / (120. * d * s);
0152 x2 = xy_x * xy_x;
0153 lp_lat = pe + x2 * (-I7 + I8 * x2);
0154 lp_lon = xy_x * (I9 + x2 * (-I10 + x2 * I11));
0155 }
0156
0157 static inline std::string get_name()
0158 {
0159 return "labrd_ellipsoid";
0160 }
0161
0162 };
0163
0164
0165 template <typename Params, typename Parameters, typename T>
0166 inline void setup_labrd(Params const& params, Parameters const& par, par_labrd<T>& proj_parm)
0167 {
0168 static const T fourth_pi = detail::fourth_pi<T>();
0169
0170 T Az, sinp, R, N, t;
0171
0172 Az = pj_get_param_r<T, srs::spar::azi>(params, "azi", srs::dpar::azi);
0173 sinp = sin(par.phi0);
0174 t = 1. - par.es * sinp * sinp;
0175 N = 1. / sqrt(t);
0176 R = par.one_es * N / t;
0177 proj_parm.kRg = par.k0 * sqrt( N * R );
0178 proj_parm.p0s = atan( sqrt(R / N) * tan(par.phi0) );
0179 proj_parm.A = sinp / sin(proj_parm.p0s);
0180 t = par.e * sinp;
0181 proj_parm.C = .5 * par.e * proj_parm.A * log((1. + t)/(1. - t)) +
0182 - proj_parm.A * log( tan(fourth_pi + .5 * par.phi0))
0183 + log( tan(fourth_pi + .5 * proj_parm.p0s));
0184 t = Az + Az;
0185 proj_parm.Ca = (1. - cos(t)) * ( proj_parm.Cb = 1. / (12. * proj_parm.kRg * proj_parm.kRg) );
0186 proj_parm.Cb *= sin(t);
0187 proj_parm.Cc = 3. * (proj_parm.Ca * proj_parm.Ca - proj_parm.Cb * proj_parm.Cb);
0188 proj_parm.Cd = 6. * proj_parm.Ca * proj_parm.Cb;
0189 }
0190
0191 }}
0192 #endif
0193
0194
0195
0196
0197
0198
0199
0200
0201
0202
0203
0204
0205
0206
0207
0208
0209
0210 template <typename T, typename Parameters>
0211 struct labrd_ellipsoid : public detail::labrd::base_labrd_ellipsoid<T, Parameters>
0212 {
0213 template <typename Params>
0214 inline labrd_ellipsoid(Params const& params, Parameters const& par)
0215 {
0216 detail::labrd::setup_labrd(params, par, this->m_proj_parm);
0217 }
0218 };
0219
0220 #ifndef DOXYGEN_NO_DETAIL
0221 namespace detail
0222 {
0223
0224
0225 BOOST_GEOMETRY_PROJECTIONS_DETAIL_STATIC_PROJECTION_FI(srs::spar::proj_labrd, labrd_ellipsoid)
0226
0227
0228 BOOST_GEOMETRY_PROJECTIONS_DETAIL_FACTORY_ENTRY_FI(labrd_entry, labrd_ellipsoid)
0229
0230 BOOST_GEOMETRY_PROJECTIONS_DETAIL_FACTORY_INIT_BEGIN(labrd_init)
0231 {
0232 BOOST_GEOMETRY_PROJECTIONS_DETAIL_FACTORY_INIT_ENTRY(labrd, labrd_entry)
0233 }
0234
0235 }
0236 #endif
0237
0238 }
0239
0240 }}
0241
0242 #endif
0243