gnom.hpp 9.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249
  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_GNOM_HPP
  31. #define BOOST_GEOMETRY_PROJECTIONS_GNOM_HPP
  32. #include <boost/config.hpp>
  33. #include <boost/geometry/util/math.hpp>
  34. #include <boost/math/special_functions/hypot.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/projects.hpp>
  38. #include <boost/geometry/srs/projections/impl/factory_entry.hpp>
  39. namespace boost { namespace geometry
  40. {
  41. namespace projections
  42. {
  43. #ifndef DOXYGEN_NO_DETAIL
  44. namespace detail { namespace gnom
  45. {
  46. static const double epsilon10 = 1.e-10;
  47. enum mode_type {
  48. n_pole = 0,
  49. s_pole = 1,
  50. equit = 2,
  51. obliq = 3
  52. };
  53. template <typename T>
  54. struct par_gnom
  55. {
  56. T sinph0;
  57. T cosph0;
  58. mode_type mode;
  59. };
  60. template <typename T, typename Parameters>
  61. struct base_gnom_spheroid
  62. {
  63. par_gnom<T> m_proj_parm;
  64. // FORWARD(s_forward) spheroid
  65. // Project coordinates from geographic (lon, lat) to cartesian (x, y)
  66. inline void fwd(Parameters const& , T const& lp_lon, T const& lp_lat, T& xy_x, T& xy_y) const
  67. {
  68. T coslam, cosphi, sinphi;
  69. sinphi = sin(lp_lat);
  70. cosphi = cos(lp_lat);
  71. coslam = cos(lp_lon);
  72. switch (this->m_proj_parm.mode) {
  73. case equit:
  74. xy_y = cosphi * coslam;
  75. break;
  76. case obliq:
  77. xy_y = this->m_proj_parm.sinph0 * sinphi + this->m_proj_parm.cosph0 * cosphi * coslam;
  78. break;
  79. case s_pole:
  80. xy_y = - sinphi;
  81. break;
  82. case n_pole:
  83. xy_y = sinphi;
  84. break;
  85. }
  86. if (xy_y <= epsilon10) {
  87. BOOST_THROW_EXCEPTION( projection_exception(error_tolerance_condition) );
  88. }
  89. xy_x = (xy_y = 1. / xy_y) * cosphi * sin(lp_lon);
  90. switch (this->m_proj_parm.mode) {
  91. case equit:
  92. xy_y *= sinphi;
  93. break;
  94. case obliq:
  95. xy_y *= this->m_proj_parm.cosph0 * sinphi - this->m_proj_parm.sinph0 * cosphi * coslam;
  96. break;
  97. case n_pole:
  98. coslam = - coslam;
  99. BOOST_FALLTHROUGH;
  100. case s_pole:
  101. xy_y *= cosphi * coslam;
  102. break;
  103. }
  104. }
  105. // INVERSE(s_inverse) spheroid
  106. // Project coordinates from cartesian (x, y) to geographic (lon, lat)
  107. inline void inv(Parameters const& par, T xy_x, T xy_y, T& lp_lon, T& lp_lat) const
  108. {
  109. static const T half_pi = detail::half_pi<T>();
  110. T rh, cosz, sinz;
  111. rh = boost::math::hypot(xy_x, xy_y);
  112. sinz = sin(lp_lat = atan(rh));
  113. cosz = sqrt(1. - sinz * sinz);
  114. if (fabs(rh) <= epsilon10) {
  115. lp_lat = par.phi0;
  116. lp_lon = 0.;
  117. } else {
  118. switch (this->m_proj_parm.mode) {
  119. case obliq:
  120. lp_lat = cosz * this->m_proj_parm.sinph0 + xy_y * sinz * this->m_proj_parm.cosph0 / rh;
  121. if (fabs(lp_lat) >= 1.)
  122. lp_lat = lp_lat > 0. ? half_pi : -half_pi;
  123. else
  124. lp_lat = asin(lp_lat);
  125. xy_y = (cosz - this->m_proj_parm.sinph0 * sin(lp_lat)) * rh;
  126. xy_x *= sinz * this->m_proj_parm.cosph0;
  127. break;
  128. case equit:
  129. lp_lat = xy_y * sinz / rh;
  130. if (fabs(lp_lat) >= 1.)
  131. lp_lat = lp_lat > 0. ? half_pi : -half_pi;
  132. else
  133. lp_lat = asin(lp_lat);
  134. xy_y = cosz * rh;
  135. xy_x *= sinz;
  136. break;
  137. case s_pole:
  138. lp_lat -= half_pi;
  139. break;
  140. case n_pole:
  141. lp_lat = half_pi - lp_lat;
  142. xy_y = -xy_y;
  143. break;
  144. }
  145. lp_lon = atan2(xy_x, xy_y);
  146. }
  147. }
  148. static inline std::string get_name()
  149. {
  150. return "gnom_spheroid";
  151. }
  152. };
  153. // Gnomonic
  154. template <typename Parameters, typename T>
  155. inline void setup_gnom(Parameters& par, par_gnom<T>& proj_parm)
  156. {
  157. static const T half_pi = detail::half_pi<T>();
  158. if (fabs(fabs(par.phi0) - half_pi) < epsilon10) {
  159. proj_parm.mode = par.phi0 < 0. ? s_pole : n_pole;
  160. } else if (fabs(par.phi0) < epsilon10) {
  161. proj_parm.mode = equit;
  162. } else {
  163. proj_parm.mode = obliq;
  164. proj_parm.sinph0 = sin(par.phi0);
  165. proj_parm.cosph0 = cos(par.phi0);
  166. }
  167. par.es = 0.;
  168. }
  169. }} // namespace detail::gnom
  170. #endif // doxygen
  171. /*!
  172. \brief Gnomonic projection
  173. \ingroup projections
  174. \tparam Geographic latlong point type
  175. \tparam Cartesian xy point type
  176. \tparam Parameters parameter type
  177. \par Projection characteristics
  178. - Azimuthal
  179. - Spheroid
  180. \par Example
  181. \image html ex_gnom.gif
  182. */
  183. template <typename T, typename Parameters>
  184. struct gnom_spheroid : public detail::gnom::base_gnom_spheroid<T, Parameters>
  185. {
  186. template <typename Params>
  187. inline gnom_spheroid(Params const& , Parameters & par)
  188. {
  189. detail::gnom::setup_gnom(par, this->m_proj_parm);
  190. }
  191. };
  192. #ifndef DOXYGEN_NO_DETAIL
  193. namespace detail
  194. {
  195. // Static projection
  196. BOOST_GEOMETRY_PROJECTIONS_DETAIL_STATIC_PROJECTION_FI(srs::spar::proj_gnom, gnom_spheroid)
  197. // Factory entry(s)
  198. BOOST_GEOMETRY_PROJECTIONS_DETAIL_FACTORY_ENTRY_FI(gnom_entry, gnom_spheroid)
  199. BOOST_GEOMETRY_PROJECTIONS_DETAIL_FACTORY_INIT_BEGIN(gnom_init)
  200. {
  201. BOOST_GEOMETRY_PROJECTIONS_DETAIL_FACTORY_INIT_ENTRY(gnom, gnom_entry);
  202. }
  203. } // namespace detail
  204. #endif // doxygen
  205. } // namespace projections
  206. }} // namespace boost::geometry
  207. #endif // BOOST_GEOMETRY_PROJECTIONS_GNOM_HPP