libcarla/include/system/boost/geometry/algorithms/detail/make/make.hpp
2024-10-18 13:19:59 +08:00

74 lines
2.2 KiB
C++

// Boost.Geometry
// Copyright (c) 2019 Barend Gehrels, Amsterdam, the Netherlands.
// Use, modification and distribution is subject to the Boost Software License,
// Version 1.0. (See accompanying file LICENSE_1_0.txt or copy at
// http://www.boost.org/LICENSE_1_0.txt)
#ifndef BOOST_GEOMETRY_ALGORITHMS_DETAIL_MAKE_MAKE_HPP
#define BOOST_GEOMETRY_ALGORITHMS_DETAIL_MAKE_MAKE_HPP
#include <boost/geometry/geometries/infinite_line.hpp>
#include <boost/geometry/core/access.hpp>
namespace boost { namespace geometry
{
#ifndef DOXYGEN_NO_DETAIL
namespace detail { namespace make
{
template <typename Type, typename Coordinate>
inline
model::infinite_line<Type> make_infinite_line(Coordinate const& x1,
Coordinate const& y1, Coordinate const& x2, Coordinate const& y2)
{
model::infinite_line<Type> result;
result.a = y1 - y2;
result.b = x2 - x1;
result.c = -result.a * x1 - result.b * y1;
return result;
}
template <typename Type, typename Point>
inline
model::infinite_line<Type> make_infinite_line(Point const& a, Point const& b)
{
return make_infinite_line<Type>(geometry::get<0>(a), geometry::get<1>(a),
geometry::get<0>(b), geometry::get<1>(b));
}
template <typename Type, typename Segment>
inline
model::infinite_line<Type> make_infinite_line(Segment const& segment)
{
return make_infinite_line<Type>(geometry::get<0, 0>(segment),
geometry::get<0, 1>(segment),
geometry::get<1, 0>(segment),
geometry::get<1, 1>(segment));
}
template <typename Type, typename Point>
inline
model::infinite_line<Type> make_perpendicular_line(Point const& a, Point const& b, Point const& c)
{
// https://www.math-only-math.com/equation-of-a-line-perpendicular-to-a-line.html
model::infinite_line<Type> const line = make_infinite_line<Type>(a, b);
model::infinite_line<Type> result;
result.a = line.b;
result.b = -line.a;
// Lines with any result.c are perpendicular to a->b
// Calculate this result such that it goes through point c
result.c = -result.a * geometry::get<0>(c) - result.b * geometry::get<1>(c);
return result;
}
}} // namespace detail::make
#endif // DOXYGEN_NO_DETAIL
}} // namespace boost::geometry
#endif // BOOST_GEOMETRY_ALGORITHMS_DETAIL_MAKE_MAKE_HPP