tpeqd.hpp 9.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236
  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.
  4. // Modifications copyright (c) 2017-2018, 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/base_static.hpp>
  35. #include <boost/geometry/srs/projections/impl/base_dynamic.hpp>
  36. #include <boost/geometry/srs/projections/impl/projects.hpp>
  37. #include <boost/geometry/srs/projections/impl/factory_entry.hpp>
  38. #include <boost/geometry/srs/projections/impl/aasincos.hpp>
  39. namespace boost { namespace geometry
  40. {
  41. namespace srs { namespace par4
  42. {
  43. struct tpeqd {}; // Two Point Equidistant
  44. }} //namespace srs::par4
  45. namespace projections
  46. {
  47. #ifndef DOXYGEN_NO_DETAIL
  48. namespace detail { namespace tpeqd
  49. {
  50. template <typename T>
  51. struct par_tpeqd
  52. {
  53. T cp1, sp1, cp2, sp2, ccs, cs, sc, r2z0, z02, dlam2;
  54. T hz0, thz0, rhshz0, ca, sa, lp, lamc;
  55. };
  56. // template class, using CRTP to implement forward/inverse
  57. template <typename T, typename Parameters>
  58. struct base_tpeqd_spheroid
  59. : public base_t_fi<base_tpeqd_spheroid<T, Parameters>, T, Parameters>
  60. {
  61. par_tpeqd<T> m_proj_parm;
  62. inline base_tpeqd_spheroid(const Parameters& par)
  63. : base_t_fi<base_tpeqd_spheroid<T, Parameters>, T, Parameters>(*this, par)
  64. {}
  65. // FORWARD(s_forward) sphere
  66. // Project coordinates from geographic (lon, lat) to cartesian (x, y)
  67. inline void fwd(T& lp_lon, T& lp_lat, T& xy_x, T& xy_y) const
  68. {
  69. T t, z1, z2, dl1, dl2, sp, cp;
  70. sp = sin(lp_lat);
  71. cp = cos(lp_lat);
  72. z1 = aacos(this->m_proj_parm.sp1 * sp + this->m_proj_parm.cp1 * cp * cos(dl1 = lp_lon + this->m_proj_parm.dlam2));
  73. z2 = aacos(this->m_proj_parm.sp2 * sp + this->m_proj_parm.cp2 * cp * cos(dl2 = lp_lon - this->m_proj_parm.dlam2));
  74. z1 *= z1;
  75. z2 *= z2;
  76. xy_x = this->m_proj_parm.r2z0 * (t = z1 - z2);
  77. t = this->m_proj_parm.z02 - t;
  78. xy_y = this->m_proj_parm.r2z0 * asqrt(4. * this->m_proj_parm.z02 * z2 - t * t);
  79. if ((this->m_proj_parm.ccs * sp - cp * (this->m_proj_parm.cs * sin(dl1) - this->m_proj_parm.sc * sin(dl2))) < 0.)
  80. xy_y = -xy_y;
  81. }
  82. // INVERSE(s_inverse) sphere
  83. // Project coordinates from cartesian (x, y) to geographic (lon, lat)
  84. inline void inv(T& xy_x, T& xy_y, T& lp_lon, T& lp_lat) const
  85. {
  86. T cz1, cz2, s, d, cp, sp;
  87. cz1 = cos(boost::math::hypot(xy_y, xy_x + this->m_proj_parm.hz0));
  88. cz2 = cos(boost::math::hypot(xy_y, xy_x - this->m_proj_parm.hz0));
  89. s = cz1 + cz2;
  90. d = cz1 - cz2;
  91. lp_lon = - atan2(d, (s * this->m_proj_parm.thz0));
  92. lp_lat = aacos(boost::math::hypot(this->m_proj_parm.thz0 * s, d) * this->m_proj_parm.rhshz0);
  93. if ( xy_y < 0. )
  94. lp_lat = - lp_lat;
  95. /* lam--phi now in system relative to P1--P2 base equator */
  96. sp = sin(lp_lat);
  97. cp = cos(lp_lat);
  98. lp_lat = aasin(this->m_proj_parm.sa * sp + this->m_proj_parm.ca * cp * (s = cos(lp_lon -= this->m_proj_parm.lp)));
  99. 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;
  100. }
  101. static inline std::string get_name()
  102. {
  103. return "tpeqd_spheroid";
  104. }
  105. };
  106. // Two Point Equidistant
  107. template <typename Parameters, typename T>
  108. inline void setup_tpeqd(Parameters& par, par_tpeqd<T>& proj_parm)
  109. {
  110. T lam_1, lam_2, phi_1, phi_2, A12, pp;
  111. /* get control point locations */
  112. phi_1 = pj_get_param_r(par.params, "lat_1");
  113. lam_1 = pj_get_param_r(par.params, "lon_1");
  114. phi_2 = pj_get_param_r(par.params, "lat_2");
  115. lam_2 = pj_get_param_r(par.params, "lon_2");
  116. if (phi_1 == phi_2 && lam_1 == lam_2)
  117. BOOST_THROW_EXCEPTION( projection_exception(error_control_point_no_dist) );
  118. par.lam0 = adjlon(0.5 * (lam_1 + lam_2));
  119. proj_parm.dlam2 = adjlon(lam_2 - lam_1);
  120. proj_parm.cp1 = cos(phi_1);
  121. proj_parm.cp2 = cos(phi_2);
  122. proj_parm.sp1 = sin(phi_1);
  123. proj_parm.sp2 = sin(phi_2);
  124. proj_parm.cs = proj_parm.cp1 * proj_parm.sp2;
  125. proj_parm.sc = proj_parm.sp1 * proj_parm.cp2;
  126. proj_parm.ccs = proj_parm.cp1 * proj_parm.cp2 * sin(proj_parm.dlam2);
  127. proj_parm.z02 = aacos(proj_parm.sp1 * proj_parm.sp2 + proj_parm.cp1 * proj_parm.cp2 * cos(proj_parm.dlam2));
  128. proj_parm.hz0 = .5 * proj_parm.z02;
  129. A12 = atan2(proj_parm.cp2 * sin(proj_parm.dlam2),
  130. proj_parm.cp1 * proj_parm.sp2 - proj_parm.sp1 * proj_parm.cp2 * cos(proj_parm.dlam2));
  131. proj_parm.ca = cos(pp = aasin(proj_parm.cp1 * sin(A12)));
  132. proj_parm.sa = sin(pp);
  133. proj_parm.lp = adjlon(atan2(proj_parm.cp1 * cos(A12), proj_parm.sp1) - proj_parm.hz0);
  134. proj_parm.dlam2 *= .5;
  135. proj_parm.lamc = geometry::math::half_pi<T>() - atan2(sin(A12) * proj_parm.sp1, cos(A12)) - proj_parm.dlam2;
  136. proj_parm.thz0 = tan(proj_parm.hz0);
  137. proj_parm.rhshz0 = .5 / sin(proj_parm.hz0);
  138. proj_parm.r2z0 = 0.5 / proj_parm.z02;
  139. proj_parm.z02 *= proj_parm.z02;
  140. par.es = 0.;
  141. }
  142. }} // namespace detail::tpeqd
  143. #endif // doxygen
  144. /*!
  145. \brief Two Point Equidistant projection
  146. \ingroup projections
  147. \tparam Geographic latlong point type
  148. \tparam Cartesian xy point type
  149. \tparam Parameters parameter type
  150. \par Projection characteristics
  151. - Miscellaneous
  152. - Spheroid
  153. \par Projection parameters
  154. - lat_1: Latitude of first standard parallel (degrees)
  155. - lon_1 (degrees)
  156. - lat_2: Latitude of second standard parallel (degrees)
  157. - lon_2 (degrees)
  158. \par Example
  159. \image html ex_tpeqd.gif
  160. */
  161. template <typename T, typename Parameters>
  162. struct tpeqd_spheroid : public detail::tpeqd::base_tpeqd_spheroid<T, Parameters>
  163. {
  164. inline tpeqd_spheroid(const Parameters& par) : detail::tpeqd::base_tpeqd_spheroid<T, Parameters>(par)
  165. {
  166. detail::tpeqd::setup_tpeqd(this->m_par, this->m_proj_parm);
  167. }
  168. };
  169. #ifndef DOXYGEN_NO_DETAIL
  170. namespace detail
  171. {
  172. // Static projection
  173. BOOST_GEOMETRY_PROJECTIONS_DETAIL_STATIC_PROJECTION(srs::par4::tpeqd, tpeqd_spheroid, tpeqd_spheroid)
  174. // Factory entry(s)
  175. template <typename T, typename Parameters>
  176. class tpeqd_entry : public detail::factory_entry<T, Parameters>
  177. {
  178. public :
  179. virtual base_v<T, Parameters>* create_new(const Parameters& par) const
  180. {
  181. return new base_v_fi<tpeqd_spheroid<T, Parameters>, T, Parameters>(par);
  182. }
  183. };
  184. template <typename T, typename Parameters>
  185. inline void tpeqd_init(detail::base_factory<T, Parameters>& factory)
  186. {
  187. factory.add_to_factory("tpeqd", new tpeqd_entry<T, Parameters>);
  188. }
  189. } // namespace detail
  190. #endif // doxygen
  191. } // namespace projections
  192. }} // namespace boost::geometry
  193. #endif // BOOST_GEOMETRY_PROJECTIONS_TPEQD_HPP