tpeqd.hpp 9.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216
  1. // Boost.Geometry - gis-projections (based on PROJ4)
  2. // Copyright (c) 2008-2015 Barend Gehrels, Amsterdam, the Netherlands.
  3. // This file was modified by Oracle on 2017, 2018, 2019.
  4. // Modifications copyright (c) 2017-2019, Oracle and/or its affiliates.
  5. // Contributed and/or modified by Adam Wulkiewicz, on behalf of Oracle.
  6. // Use, modification and distribution is subject to the Boost Software License,
  7. // Version 1.0. (See accompanying file LICENSE_1_0.txt or copy at
  8. // http://www.boost.org/LICENSE_1_0.txt)
  9. // This file is converted from PROJ4, http://trac.osgeo.org/proj
  10. // PROJ4 is originally written by Gerald Evenden (then of the USGS)
  11. // PROJ4 is maintained by Frank Warmerdam
  12. // PROJ4 is converted to Boost.Geometry by Barend Gehrels
  13. // Last updated version of proj: 5.0.0
  14. // Original copyright notice:
  15. // Permission is hereby granted, free of charge, to any person obtaining a
  16. // copy of this software and associated documentation files (the "Software"),
  17. // to deal in the Software without restriction, including without limitation
  18. // the rights to use, copy, modify, merge, publish, distribute, sublicense,
  19. // and/or sell copies of the Software, and to permit persons to whom the
  20. // Software is furnished to do so, subject to the following conditions:
  21. // The above copyright notice and this permission notice shall be included
  22. // in all copies or substantial portions of the Software.
  23. // THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
  24. // OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  25. // FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  26. // THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  27. // LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  28. // FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
  29. // DEALINGS IN THE SOFTWARE.
  30. #ifndef BOOST_GEOMETRY_PROJECTIONS_TPEQD_HPP
  31. #define BOOST_GEOMETRY_PROJECTIONS_TPEQD_HPP
  32. #include <boost/geometry/util/math.hpp>
  33. #include <boost/math/special_functions/hypot.hpp>
  34. #include <boost/geometry/srs/projections/impl/aasincos.hpp>
  35. #include <boost/geometry/srs/projections/impl/base_static.hpp>
  36. #include <boost/geometry/srs/projections/impl/base_dynamic.hpp>
  37. #include <boost/geometry/srs/projections/impl/factory_entry.hpp>
  38. #include <boost/geometry/srs/projections/impl/pj_param.hpp>
  39. #include <boost/geometry/srs/projections/impl/projects.hpp>
  40. namespace boost { namespace geometry
  41. {
  42. namespace projections
  43. {
  44. #ifndef DOXYGEN_NO_DETAIL
  45. namespace detail { namespace tpeqd
  46. {
  47. template <typename T>
  48. struct par_tpeqd
  49. {
  50. T cp1, sp1, cp2, sp2, ccs, cs, sc, r2z0, z02, dlam2;
  51. T hz0, thz0, rhshz0, ca, sa, lp, lamc;
  52. };
  53. template <typename T, typename Parameters>
  54. struct base_tpeqd_spheroid
  55. {
  56. par_tpeqd<T> m_proj_parm;
  57. // FORWARD(s_forward) sphere
  58. // Project coordinates from geographic (lon, lat) to cartesian (x, y)
  59. inline void fwd(Parameters const& , T const& lp_lon, T const& lp_lat, T& xy_x, T& xy_y) const
  60. {
  61. T t, z1, z2, dl1, dl2, sp, cp;
  62. sp = sin(lp_lat);
  63. cp = cos(lp_lat);
  64. z1 = aacos(this->m_proj_parm.sp1 * sp + this->m_proj_parm.cp1 * cp * cos(dl1 = lp_lon + this->m_proj_parm.dlam2));
  65. z2 = aacos(this->m_proj_parm.sp2 * sp + this->m_proj_parm.cp2 * cp * cos(dl2 = lp_lon - this->m_proj_parm.dlam2));
  66. z1 *= z1;
  67. z2 *= z2;
  68. xy_x = this->m_proj_parm.r2z0 * (t = z1 - z2);
  69. t = this->m_proj_parm.z02 - t;
  70. xy_y = this->m_proj_parm.r2z0 * asqrt(4. * this->m_proj_parm.z02 * z2 - t * t);
  71. if ((this->m_proj_parm.ccs * sp - cp * (this->m_proj_parm.cs * sin(dl1) - this->m_proj_parm.sc * sin(dl2))) < 0.)
  72. xy_y = -xy_y;
  73. }
  74. // INVERSE(s_inverse) sphere
  75. // Project coordinates from cartesian (x, y) to geographic (lon, lat)
  76. inline void inv(Parameters const& , T const& xy_x, T const& xy_y, T& lp_lon, T& lp_lat) const
  77. {
  78. T cz1, cz2, s, d, cp, sp;
  79. cz1 = cos(boost::math::hypot(xy_y, xy_x + this->m_proj_parm.hz0));
  80. cz2 = cos(boost::math::hypot(xy_y, xy_x - this->m_proj_parm.hz0));
  81. s = cz1 + cz2;
  82. d = cz1 - cz2;
  83. lp_lon = - atan2(d, (s * this->m_proj_parm.thz0));
  84. lp_lat = aacos(boost::math::hypot(this->m_proj_parm.thz0 * s, d) * this->m_proj_parm.rhshz0);
  85. if ( xy_y < 0. )
  86. lp_lat = - lp_lat;
  87. /* lam--phi now in system relative to P1--P2 base equator */
  88. sp = sin(lp_lat);
  89. cp = cos(lp_lat);
  90. lp_lat = aasin(this->m_proj_parm.sa * sp + this->m_proj_parm.ca * cp * (s = cos(lp_lon -= this->m_proj_parm.lp)));
  91. lp_lon = atan2(cp * sin(lp_lon), this->m_proj_parm.sa * cp * s - this->m_proj_parm.ca * sp) + this->m_proj_parm.lamc;
  92. }
  93. static inline std::string get_name()
  94. {
  95. return "tpeqd_spheroid";
  96. }
  97. };
  98. // Two Point Equidistant
  99. template <typename Params, typename Parameters, typename T>
  100. inline void setup_tpeqd(Params const& params, Parameters& par, par_tpeqd<T>& proj_parm)
  101. {
  102. T lam_1, lam_2, phi_1, phi_2, A12, pp;
  103. /* get control point locations */
  104. phi_1 = pj_get_param_r<T, srs::spar::lat_1>(params, "lat_1", srs::dpar::lat_1);
  105. lam_1 = pj_get_param_r<T, srs::spar::lon_1>(params, "lon_1", srs::dpar::lon_1);
  106. phi_2 = pj_get_param_r<T, srs::spar::lat_2>(params, "lat_2", srs::dpar::lat_2);
  107. lam_2 = pj_get_param_r<T, srs::spar::lon_2>(params, "lon_2", srs::dpar::lon_2);
  108. if (phi_1 == phi_2 && lam_1 == lam_2)
  109. BOOST_THROW_EXCEPTION( projection_exception(error_control_point_no_dist) );
  110. par.lam0 = adjlon(0.5 * (lam_1 + lam_2));
  111. proj_parm.dlam2 = adjlon(lam_2 - lam_1);
  112. proj_parm.cp1 = cos(phi_1);
  113. proj_parm.cp2 = cos(phi_2);
  114. proj_parm.sp1 = sin(phi_1);
  115. proj_parm.sp2 = sin(phi_2);
  116. proj_parm.cs = proj_parm.cp1 * proj_parm.sp2;
  117. proj_parm.sc = proj_parm.sp1 * proj_parm.cp2;
  118. proj_parm.ccs = proj_parm.cp1 * proj_parm.cp2 * sin(proj_parm.dlam2);
  119. proj_parm.z02 = aacos(proj_parm.sp1 * proj_parm.sp2 + proj_parm.cp1 * proj_parm.cp2 * cos(proj_parm.dlam2));
  120. proj_parm.hz0 = .5 * proj_parm.z02;
  121. A12 = atan2(proj_parm.cp2 * sin(proj_parm.dlam2),
  122. proj_parm.cp1 * proj_parm.sp2 - proj_parm.sp1 * proj_parm.cp2 * cos(proj_parm.dlam2));
  123. proj_parm.ca = cos(pp = aasin(proj_parm.cp1 * sin(A12)));
  124. proj_parm.sa = sin(pp);
  125. proj_parm.lp = adjlon(atan2(proj_parm.cp1 * cos(A12), proj_parm.sp1) - proj_parm.hz0);
  126. proj_parm.dlam2 *= .5;
  127. proj_parm.lamc = geometry::math::half_pi<T>() - atan2(sin(A12) * proj_parm.sp1, cos(A12)) - proj_parm.dlam2;
  128. proj_parm.thz0 = tan(proj_parm.hz0);
  129. proj_parm.rhshz0 = .5 / sin(proj_parm.hz0);
  130. proj_parm.r2z0 = 0.5 / proj_parm.z02;
  131. proj_parm.z02 *= proj_parm.z02;
  132. par.es = 0.;
  133. }
  134. }} // namespace detail::tpeqd
  135. #endif // doxygen
  136. /*!
  137. \brief Two Point Equidistant projection
  138. \ingroup projections
  139. \tparam Geographic latlong point type
  140. \tparam Cartesian xy point type
  141. \tparam Parameters parameter type
  142. \par Projection characteristics
  143. - Miscellaneous
  144. - Spheroid
  145. \par Projection parameters
  146. - lat_1: Latitude of first standard parallel (degrees)
  147. - lon_1 (degrees)
  148. - lat_2: Latitude of second standard parallel (degrees)
  149. - lon_2 (degrees)
  150. \par Example
  151. \image html ex_tpeqd.gif
  152. */
  153. template <typename T, typename Parameters>
  154. struct tpeqd_spheroid : public detail::tpeqd::base_tpeqd_spheroid<T, Parameters>
  155. {
  156. template <typename Params>
  157. inline tpeqd_spheroid(Params const& params, Parameters & par)
  158. {
  159. detail::tpeqd::setup_tpeqd(params, par, this->m_proj_parm);
  160. }
  161. };
  162. #ifndef DOXYGEN_NO_DETAIL
  163. namespace detail
  164. {
  165. // Static projection
  166. BOOST_GEOMETRY_PROJECTIONS_DETAIL_STATIC_PROJECTION_FI(srs::spar::proj_tpeqd, tpeqd_spheroid)
  167. // Factory entry(s)
  168. BOOST_GEOMETRY_PROJECTIONS_DETAIL_FACTORY_ENTRY_FI(tpeqd_entry, tpeqd_spheroid)
  169. BOOST_GEOMETRY_PROJECTIONS_DETAIL_FACTORY_INIT_BEGIN(tpeqd_init)
  170. {
  171. BOOST_GEOMETRY_PROJECTIONS_DETAIL_FACTORY_INIT_ENTRY(tpeqd, tpeqd_entry)
  172. }
  173. } // namespace detail
  174. #endif // doxygen
  175. } // namespace projections
  176. }} // namespace boost::geometry
  177. #endif // BOOST_GEOMETRY_PROJECTIONS_TPEQD_HPP