diff options
author | maxim-yurchuk <maxim-yurchuk@yandex-team.com> | 2025-02-11 13:26:52 +0300 |
---|---|---|
committer | maxim-yurchuk <maxim-yurchuk@yandex-team.com> | 2025-02-11 13:57:59 +0300 |
commit | f895bba65827952ed934b2b46f9a45e30a191fd2 (patch) | |
tree | 03260c906d9ec41cdc03e2a496b15d407459cec0 /contrib/python/matplotlib/py3/src/tri/_tri.cpp | |
parent | 5f7060466f7b9707818c2091e1a25c14f33c3474 (diff) | |
download | ydb-f895bba65827952ed934b2b46f9a45e30a191fd2.tar.gz |
Remove deps on pandas
<https://github.com/ydb-platform/ydb/pull/14418>
<https://github.com/ydb-platform/ydb/pull/14419>
\-- аналогичные правки в gh
Хочу залить в обход синка, чтобы посмотреть удалится ли pandas в нашей gh репе через piglet
commit_hash:abca127aa37d4dbb94b07e1e18cdb8eb5b711860
Diffstat (limited to 'contrib/python/matplotlib/py3/src/tri/_tri.cpp')
-rw-r--r-- | contrib/python/matplotlib/py3/src/tri/_tri.cpp | 2074 |
1 files changed, 0 insertions, 2074 deletions
diff --git a/contrib/python/matplotlib/py3/src/tri/_tri.cpp b/contrib/python/matplotlib/py3/src/tri/_tri.cpp deleted file mode 100644 index 2674a3140b3..00000000000 --- a/contrib/python/matplotlib/py3/src/tri/_tri.cpp +++ /dev/null @@ -1,2074 +0,0 @@ -/* This file contains liberal use of asserts to assist code development and - * debugging. Standard matplotlib builds disable asserts so they cause no - * performance reduction. To enable the asserts, you need to undefine the - * NDEBUG macro, which is achieved by adding the following - * undef_macros=['NDEBUG'] - * to the appropriate make_extension call in setupext.py, and then rebuilding. - */ -#include "../mplutils.h" -#include "_tri.h" - -#include <algorithm> -#include <random> -#include <set> - - -TriEdge::TriEdge() - : tri(-1), edge(-1) -{} - -TriEdge::TriEdge(int tri_, int edge_) - : tri(tri_), edge(edge_) -{} - -bool TriEdge::operator<(const TriEdge& other) const -{ - if (tri != other.tri) - return tri < other.tri; - else - return edge < other.edge; -} - -bool TriEdge::operator==(const TriEdge& other) const -{ - return tri == other.tri && edge == other.edge; -} - -bool TriEdge::operator!=(const TriEdge& other) const -{ - return !operator==(other); -} - -std::ostream& operator<<(std::ostream& os, const TriEdge& tri_edge) -{ - return os << tri_edge.tri << ' ' << tri_edge.edge; -} - - - -XY::XY() -{} - -XY::XY(const double& x_, const double& y_) - : x(x_), y(y_) -{} - -double XY::angle() const -{ - return atan2(y, x); -} - -double XY::cross_z(const XY& other) const -{ - return x*other.y - y*other.x; -} - -bool XY::is_right_of(const XY& other) const -{ - if (x == other.x) - return y > other.y; - else - return x > other.x; -} - -bool XY::operator==(const XY& other) const -{ - return x == other.x && y == other.y; -} - -bool XY::operator!=(const XY& other) const -{ - return x != other.x || y != other.y; -} - -XY XY::operator*(const double& multiplier) const -{ - return XY(x*multiplier, y*multiplier); -} - -const XY& XY::operator+=(const XY& other) -{ - x += other.x; - y += other.y; - return *this; -} - -const XY& XY::operator-=(const XY& other) -{ - x -= other.x; - y -= other.y; - return *this; -} - -XY XY::operator+(const XY& other) const -{ - return XY(x + other.x, y + other.y); -} - -XY XY::operator-(const XY& other) const -{ - return XY(x - other.x, y - other.y); -} - -std::ostream& operator<<(std::ostream& os, const XY& xy) -{ - return os << '(' << xy.x << ' ' << xy.y << ')'; -} - - - -XYZ::XYZ(const double& x_, const double& y_, const double& z_) - : x(x_), y(y_), z(z_) -{} - -XYZ XYZ::cross(const XYZ& other) const -{ - return XYZ(y*other.z - z*other.y, - z*other.x - x*other.z, - x*other.y - y*other.x); -} - -double XYZ::dot(const XYZ& other) const -{ - return x*other.x + y*other.y + z*other.z; -} - -XYZ XYZ::operator-(const XYZ& other) const -{ - return XYZ(x - other.x, y - other.y, z - other.z); -} - -std::ostream& operator<<(std::ostream& os, const XYZ& xyz) -{ - return os << '(' << xyz.x << ' ' << xyz.y << ' ' << xyz.z << ')'; -} - - - -BoundingBox::BoundingBox() - : empty(true), lower(0.0, 0.0), upper(0.0, 0.0) -{} - -void BoundingBox::add(const XY& point) -{ - if (empty) { - empty = false; - lower = upper = point; - } else { - if (point.x < lower.x) lower.x = point.x; - else if (point.x > upper.x) upper.x = point.x; - - if (point.y < lower.y) lower.y = point.y; - else if (point.y > upper.y) upper.y = point.y; - } -} - -void BoundingBox::expand(const XY& delta) -{ - if (!empty) { - lower -= delta; - upper += delta; - } -} - - - -ContourLine::ContourLine() - : std::vector<XY>() -{} - -void ContourLine::push_back(const XY& point) -{ - if (empty() || point != back()) - std::vector<XY>::push_back(point); -} - -void ContourLine::write() const -{ - std::cout << "ContourLine of " << size() << " points:"; - for (const_iterator it = begin(); it != end(); ++it) - std::cout << ' ' << *it; - std::cout << std::endl; -} - - - -void write_contour(const Contour& contour) -{ - std::cout << "Contour of " << contour.size() << " lines." << std::endl; - for (Contour::const_iterator it = contour.begin(); it != contour.end(); ++it) - it->write(); -} - - - -Triangulation::Triangulation(const CoordinateArray& x, - const CoordinateArray& y, - const TriangleArray& triangles, - const MaskArray& mask, - const EdgeArray& edges, - const NeighborArray& neighbors, - bool correct_triangle_orientations) - : _x(x), - _y(y), - _triangles(triangles), - _mask(mask), - _edges(edges), - _neighbors(neighbors) -{ - if (_x.ndim() != 1 || _y.ndim() != 1 || _x.shape(0) != _y.shape(0)) - throw std::invalid_argument("x and y must be 1D arrays of the same length"); - - if (_triangles.ndim() != 2 || _triangles.shape(1) != 3) - throw std::invalid_argument("triangles must be a 2D array of shape (?,3)"); - - // Optional mask. - if (_mask.size() > 0 && - (_mask.ndim() != 1 || _mask.shape(0) != _triangles.shape(0))) - throw std::invalid_argument( - "mask must be a 1D array with the same length as the triangles array"); - - // Optional edges. - if (_edges.size() > 0 && - (_edges.ndim() != 2 || _edges.shape(1) != 2)) - throw std::invalid_argument("edges must be a 2D array with shape (?,2)"); - - // Optional neighbors. - if (_neighbors.size() > 0 && - (_neighbors.ndim() != 2 || _neighbors.shape() != _triangles.shape())) - throw std::invalid_argument( - "neighbors must be a 2D array with the same shape as the triangles array"); - - if (correct_triangle_orientations) - correct_triangles(); -} - -void Triangulation::calculate_boundaries() -{ - get_neighbors(); // Ensure _neighbors has been created. - - // Create set of all boundary TriEdges, which are those which do not - // have a neighbor triangle. - typedef std::set<TriEdge> BoundaryEdges; - BoundaryEdges boundary_edges; - for (int tri = 0; tri < get_ntri(); ++tri) { - if (!is_masked(tri)) { - for (int edge = 0; edge < 3; ++edge) { - if (get_neighbor(tri, edge) == -1) { - boundary_edges.insert(TriEdge(tri, edge)); - } - } - } - } - - // Take any boundary edge and follow the boundary until return to start - // point, removing edges from boundary_edges as they are used. At the same - // time, initialise the _tri_edge_to_boundary_map. - while (!boundary_edges.empty()) { - // Start of new boundary. - BoundaryEdges::iterator it = boundary_edges.begin(); - int tri = it->tri; - int edge = it->edge; - _boundaries.push_back(Boundary()); - Boundary& boundary = _boundaries.back(); - - while (true) { - boundary.push_back(TriEdge(tri, edge)); - boundary_edges.erase(it); - _tri_edge_to_boundary_map[TriEdge(tri, edge)] = - BoundaryEdge(_boundaries.size()-1, boundary.size()-1); - - // Move to next edge of current triangle. - edge = (edge+1) % 3; - - // Find start point index of boundary edge. - int point = get_triangle_point(tri, edge); - - // Find next TriEdge by traversing neighbors until find one - // without a neighbor. - while (get_neighbor(tri, edge) != -1) { - tri = get_neighbor(tri, edge); - edge = get_edge_in_triangle(tri, point); - } - - if (TriEdge(tri,edge) == boundary.front()) - break; // Reached beginning of this boundary, so finished it. - else - it = boundary_edges.find(TriEdge(tri, edge)); - } - } -} - -void Triangulation::calculate_edges() -{ - assert(!has_edges() && "Expected empty edges array"); - - // Create set of all edges, storing them with start point index less than - // end point index. - typedef std::set<Edge> EdgeSet; - EdgeSet edge_set; - for (int tri = 0; tri < get_ntri(); ++tri) { - if (!is_masked(tri)) { - for (int edge = 0; edge < 3; edge++) { - int start = get_triangle_point(tri, edge); - int end = get_triangle_point(tri, (edge+1)%3); - edge_set.insert(start > end ? Edge(start,end) : Edge(end,start)); - } - } - } - - // Convert to python _edges array. - py::ssize_t dims[2] = {static_cast<py::ssize_t>(edge_set.size()), 2}; - _edges = EdgeArray(dims); - auto edges = _edges.mutable_data(); - - int i = 0; - for (EdgeSet::const_iterator it = edge_set.begin(); it != edge_set.end(); ++it) { - edges[i++] = it->start; - edges[i++] = it->end; - } -} - -void Triangulation::calculate_neighbors() -{ - assert(!has_neighbors() && "Expected empty neighbors array"); - - // Create _neighbors array with shape (ntri,3) and initialise all to -1. - py::ssize_t dims[2] = {get_ntri(), 3}; - _neighbors = NeighborArray(dims); - auto* neighbors = _neighbors.mutable_data(); - - int tri, edge; - std::fill(neighbors, neighbors+3*get_ntri(), -1); - - // For each triangle edge (start to end point), find corresponding neighbor - // edge from end to start point. Do this by traversing all edges and - // storing them in a map from edge to TriEdge. If corresponding neighbor - // edge is already in the map, don't need to store new edge as neighbor - // already found. - typedef std::map<Edge, TriEdge> EdgeToTriEdgeMap; - EdgeToTriEdgeMap edge_to_tri_edge_map; - for (tri = 0; tri < get_ntri(); ++tri) { - if (!is_masked(tri)) { - for (edge = 0; edge < 3; ++edge) { - int start = get_triangle_point(tri, edge); - int end = get_triangle_point(tri, (edge+1)%3); - EdgeToTriEdgeMap::iterator it = - edge_to_tri_edge_map.find(Edge(end,start)); - if (it == edge_to_tri_edge_map.end()) { - // No neighbor edge exists in the edge_to_tri_edge_map, so - // add this edge to it. - edge_to_tri_edge_map[Edge(start,end)] = TriEdge(tri,edge); - } else { - // Neighbor edge found, set the two elements of _neighbors - // and remove edge from edge_to_tri_edge_map. - neighbors[3*tri + edge] = it->second.tri; - neighbors[3*it->second.tri + it->second.edge] = tri; - edge_to_tri_edge_map.erase(it); - } - } - } - } - - // Note that remaining edges in the edge_to_tri_edge_map correspond to - // boundary edges, but the boundaries are calculated separately elsewhere. -} - -Triangulation::TwoCoordinateArray Triangulation::calculate_plane_coefficients( - const CoordinateArray& z) -{ - if (z.ndim() != 1 || z.shape(0) != _x.shape(0)) - throw std::invalid_argument( - "z must be a 1D array with the same length as the triangulation x and y arrays"); - - int dims[2] = {get_ntri(), 3}; - Triangulation::TwoCoordinateArray planes_array(dims); - auto planes = planes_array.mutable_unchecked<2>(); - auto triangles = _triangles.unchecked<2>(); - auto x = _x.unchecked<1>(); - auto y = _y.unchecked<1>(); - auto z_ptr = z.unchecked<1>(); - - int point; - for (int tri = 0; tri < get_ntri(); ++tri) { - if (is_masked(tri)) { - planes(tri, 0) = 0.0; - planes(tri, 1) = 0.0; - planes(tri, 2) = 0.0; - } - else { - // Equation of plane for all points r on plane is r.normal = p - // where normal is vector normal to the plane, and p is a - // constant. Rewrite as - // r_x*normal_x + r_y*normal_y + r_z*normal_z = p - // and rearrange to give - // r_z = (-normal_x/normal_z)*r_x + (-normal_y/normal_z)*r_y + - // p/normal_z - point = triangles(tri, 0); - XYZ point0(x(point), y(point), z_ptr(point)); - point = triangles(tri, 1); - XYZ side01 = XYZ(x(point), y(point), z_ptr(point)) - point0; - point = triangles(tri, 2); - XYZ side02 = XYZ(x(point), y(point), z_ptr(point)) - point0; - - XYZ normal = side01.cross(side02); - - if (normal.z == 0.0) { - // Normal is in x-y plane which means triangle consists of - // colinear points. To avoid dividing by zero, we use the - // Moore-Penrose pseudo-inverse. - double sum2 = (side01.x*side01.x + side01.y*side01.y + - side02.x*side02.x + side02.y*side02.y); - double a = (side01.x*side01.z + side02.x*side02.z) / sum2; - double b = (side01.y*side01.z + side02.y*side02.z) / sum2; - planes(tri, 0) = a; - planes(tri, 1) = b; - planes(tri, 2) = point0.z - a*point0.x - b*point0.y; - } - else { - planes(tri, 0) = -normal.x / normal.z; // x - planes(tri, 1) = -normal.y / normal.z; // y - planes(tri, 2) = normal.dot(point0) / normal.z; // constant - } - } - } - - return planes_array; -} - -void Triangulation::correct_triangles() -{ - auto triangles = _triangles.mutable_data(); - auto neighbors = _neighbors.mutable_data(); - - for (int tri = 0; tri < get_ntri(); ++tri) { - XY point0 = get_point_coords(triangles[3*tri]); - XY point1 = get_point_coords(triangles[3*tri+1]); - XY point2 = get_point_coords(triangles[3*tri+2]); - if ( (point1 - point0).cross_z(point2 - point0) < 0.0) { - // Triangle points are clockwise, so change them to anticlockwise. - std::swap(triangles[3*tri+1], triangles[3*tri+2]); - if (has_neighbors()) - std::swap(neighbors[3*tri+1], neighbors[3*tri+2]); - } - } -} - -const Triangulation::Boundaries& Triangulation::get_boundaries() const -{ - if (_boundaries.empty()) - const_cast<Triangulation*>(this)->calculate_boundaries(); - return _boundaries; -} - -void Triangulation::get_boundary_edge(const TriEdge& triEdge, - int& boundary, - int& edge) const -{ - get_boundaries(); // Ensure _tri_edge_to_boundary_map has been created. - TriEdgeToBoundaryMap::const_iterator it = - _tri_edge_to_boundary_map.find(triEdge); - assert(it != _tri_edge_to_boundary_map.end() && - "TriEdge is not on a boundary"); - boundary = it->second.boundary; - edge = it->second.edge; -} - -int Triangulation::get_edge_in_triangle(int tri, int point) const -{ - assert(tri >= 0 && tri < get_ntri() && "Triangle index out of bounds"); - assert(point >= 0 && point < get_npoints() && "Point index out of bounds."); - - auto triangles = _triangles.data(); - - for (int edge = 0; edge < 3; ++edge) { - if (triangles[3*tri + edge] == point) - return edge; - } - return -1; // point is not in triangle. -} - -Triangulation::EdgeArray& Triangulation::get_edges() -{ - if (!has_edges()) - calculate_edges(); - return _edges; -} - -int Triangulation::get_neighbor(int tri, int edge) const -{ - assert(tri >= 0 && tri < get_ntri() && "Triangle index out of bounds"); - assert(edge >= 0 && edge < 3 && "Edge index out of bounds"); - if (!has_neighbors()) - const_cast<Triangulation&>(*this).calculate_neighbors(); - return _neighbors.data()[3*tri + edge]; -} - -TriEdge Triangulation::get_neighbor_edge(int tri, int edge) const -{ - int neighbor_tri = get_neighbor(tri, edge); - if (neighbor_tri == -1) - return TriEdge(-1,-1); - else - return TriEdge(neighbor_tri, - get_edge_in_triangle(neighbor_tri, - get_triangle_point(tri, - (edge+1)%3))); -} - -Triangulation::NeighborArray& Triangulation::get_neighbors() -{ - if (!has_neighbors()) - calculate_neighbors(); - return _neighbors; -} - -int Triangulation::get_npoints() const -{ - return _x.shape(0); -} - -int Triangulation::get_ntri() const -{ - return _triangles.shape(0); -} - -XY Triangulation::get_point_coords(int point) const -{ - assert(point >= 0 && point < get_npoints() && "Point index out of bounds."); - return XY(_x.data()[point], _y.data()[point]); -} - -int Triangulation::get_triangle_point(int tri, int edge) const -{ - assert(tri >= 0 && tri < get_ntri() && "Triangle index out of bounds"); - assert(edge >= 0 && edge < 3 && "Edge index out of bounds"); - return _triangles.data()[3*tri + edge]; -} - -int Triangulation::get_triangle_point(const TriEdge& tri_edge) const -{ - return get_triangle_point(tri_edge.tri, tri_edge.edge); -} - -bool Triangulation::has_edges() const -{ - return _edges.size() > 0; -} - -bool Triangulation::has_mask() const -{ - return _mask.size() > 0; -} - -bool Triangulation::has_neighbors() const -{ - return _neighbors.size() > 0; -} - -bool Triangulation::is_masked(int tri) const -{ - assert(tri >= 0 && tri < get_ntri() && "Triangle index out of bounds."); - return has_mask() && _mask.data()[tri]; -} - -void Triangulation::set_mask(const MaskArray& mask) -{ - if (mask.size() > 0 && - (mask.ndim() != 1 || mask.shape(0) != _triangles.shape(0))) - throw std::invalid_argument( - "mask must be a 1D array with the same length as the triangles array"); - - _mask = mask; - - // Clear derived fields so they are recalculated when needed. - _edges = EdgeArray(); - _neighbors = NeighborArray(); - _boundaries.clear(); -} - -void Triangulation::write_boundaries() const -{ - const Boundaries& bs = get_boundaries(); - std::cout << "Number of boundaries: " << bs.size() << std::endl; - for (Boundaries::const_iterator it = bs.begin(); it != bs.end(); ++it) { - const Boundary& b = *it; - std::cout << " Boundary of " << b.size() << " points: "; - for (Boundary::const_iterator itb = b.begin(); itb != b.end(); ++itb) { - std::cout << *itb << ", "; - } - std::cout << std::endl; - } -} - - - -TriContourGenerator::TriContourGenerator(Triangulation& triangulation, - const CoordinateArray& z) - : _triangulation(triangulation), - _z(z), - _interior_visited(2*_triangulation.get_ntri()), - _boundaries_visited(0), - _boundaries_used(0) -{ - if (_z.ndim() != 1 || _z.shape(0) != _triangulation.get_npoints()) - throw std::invalid_argument( - "z must be a 1D array with the same length as the x and y arrays"); -} - -void TriContourGenerator::clear_visited_flags(bool include_boundaries) -{ - // Clear _interiorVisited. - std::fill(_interior_visited.begin(), _interior_visited.end(), false); - - if (include_boundaries) { - if (_boundaries_visited.empty()) { - const Boundaries& boundaries = get_boundaries(); - - // Initialise _boundaries_visited. - _boundaries_visited.reserve(boundaries.size()); - for (Boundaries::const_iterator it = boundaries.begin(); - it != boundaries.end(); ++it) - _boundaries_visited.push_back(BoundaryVisited(it->size())); - - // Initialise _boundaries_used. - _boundaries_used = BoundariesUsed(boundaries.size()); - } - - // Clear _boundaries_visited. - for (BoundariesVisited::iterator it = _boundaries_visited.begin(); - it != _boundaries_visited.end(); ++it) - std::fill(it->begin(), it->end(), false); - - // Clear _boundaries_used. - std::fill(_boundaries_used.begin(), _boundaries_used.end(), false); - } -} - -py::tuple TriContourGenerator::contour_line_to_segs_and_kinds(const Contour& contour) -{ - // Convert all of the lines generated by a call to create_contour() into - // their Python equivalents for return to the calling function. - // A line is either a closed line loop (in which case the last point is - // identical to the first) or an open line strip. Two NumPy arrays are - // created for each line: - // vertices is a double array of shape (npoints, 2) containing the (x, y) - // coordinates of the points in the line - // codes is a uint8 array of shape (npoints,) containing the 'kind codes' - // which are defined in the Path class - // and they are appended to the Python lists vertices_list and codes_list - // respectively for return to the Python calling function. - - py::list vertices_list(contour.size()); - py::list codes_list(contour.size()); - - for (Contour::size_type i = 0; i < contour.size(); ++i) { - const ContourLine& contour_line = contour[i]; - py::ssize_t npoints = static_cast<py::ssize_t>(contour_line.size()); - - py::ssize_t segs_dims[2] = {npoints, 2}; - CoordinateArray segs(segs_dims); - double* segs_ptr = segs.mutable_data(); - - py::ssize_t codes_dims[1] = {npoints}; - CodeArray codes(codes_dims); - unsigned char* codes_ptr = codes.mutable_data(); - - for (ContourLine::const_iterator it = contour_line.begin(); - it != contour_line.end(); ++it) { - *segs_ptr++ = it->x; - *segs_ptr++ = it->y; - *codes_ptr++ = (it == contour_line.begin() ? MOVETO : LINETO); - } - - // Closed line loop has identical first and last (x, y) points. - if (contour_line.size() > 1 && - contour_line.front() == contour_line.back()) - *(codes_ptr-1) = CLOSEPOLY; - - vertices_list[i] = segs; - codes_list[i] = codes; - } - - return py::make_tuple(vertices_list, codes_list); -} - -py::tuple TriContourGenerator::contour_to_segs_and_kinds(const Contour& contour) -{ - // Convert all of the polygons generated by a call to - // create_filled_contour() into their Python equivalents for return to the - // calling function. All of the polygons' points and kinds codes are - // combined into single NumPy arrays for each; this avoids having - // to determine which polygons are holes as this will be determined by the - // renderer. If there are ntotal points in all of the polygons, the two - // NumPy arrays created are: - // vertices is a double array of shape (ntotal, 2) containing the (x, y) - // coordinates of the points in the polygons - // codes is a uint8 array of shape (ntotal,) containing the 'kind codes' - // which are defined in the Path class - // and they are returned in the Python lists vertices_list and codes_list - // respectively. - - Contour::const_iterator line; - ContourLine::const_iterator point; - - // Find total number of points in all contour lines. - py::ssize_t n_points = 0; - for (line = contour.begin(); line != contour.end(); ++line) - n_points += static_cast<py::ssize_t>(line->size()); - - // Create segs array for point coordinates. - py::ssize_t segs_dims[2] = {n_points, 2}; - TwoCoordinateArray segs(segs_dims); - double* segs_ptr = segs.mutable_data(); - - // Create kinds array for code types. - py::ssize_t codes_dims[1] = {n_points}; - CodeArray codes(codes_dims); - unsigned char* codes_ptr = codes.mutable_data(); - - for (line = contour.begin(); line != contour.end(); ++line) { - for (point = line->begin(); point != line->end(); point++) { - *segs_ptr++ = point->x; - *segs_ptr++ = point->y; - *codes_ptr++ = (point == line->begin() ? MOVETO : LINETO); - } - - if (line->size() > 1) - *(codes_ptr-1) = CLOSEPOLY; - } - - py::list vertices_list(1); - vertices_list[0] = segs; - - py::list codes_list(1); - codes_list[0] = codes; - - return py::make_tuple(vertices_list, codes_list); -} - -py::tuple TriContourGenerator::create_contour(const double& level) -{ - clear_visited_flags(false); - Contour contour; - - find_boundary_lines(contour, level); - find_interior_lines(contour, level, false, false); - - return contour_line_to_segs_and_kinds(contour); -} - -py::tuple TriContourGenerator::create_filled_contour(const double& lower_level, - const double& upper_level) -{ - if (lower_level >= upper_level) - throw std::invalid_argument("filled contour levels must be increasing"); - - clear_visited_flags(true); - Contour contour; - - find_boundary_lines_filled(contour, lower_level, upper_level); - find_interior_lines(contour, lower_level, false, true); - find_interior_lines(contour, upper_level, true, true); - - return contour_to_segs_and_kinds(contour); -} - -XY TriContourGenerator::edge_interp(int tri, int edge, const double& level) -{ - return interp(_triangulation.get_triangle_point(tri, edge), - _triangulation.get_triangle_point(tri, (edge+1)%3), - level); -} - -void TriContourGenerator::find_boundary_lines(Contour& contour, - const double& level) -{ - // Traverse boundaries to find starting points for all contour lines that - // intersect the boundaries. For each starting point found, follow the - // line to its end before continuing. - const Triangulation& triang = _triangulation; - const Boundaries& boundaries = get_boundaries(); - for (Boundaries::const_iterator it = boundaries.begin(); - it != boundaries.end(); ++it) { - const Boundary& boundary = *it; - bool startAbove, endAbove = false; - for (Boundary::const_iterator itb = boundary.begin(); - itb != boundary.end(); ++itb) { - if (itb == boundary.begin()) - startAbove = get_z(triang.get_triangle_point(*itb)) >= level; - else - startAbove = endAbove; - endAbove = get_z(triang.get_triangle_point(itb->tri, - (itb->edge+1)%3)) >= level; - if (startAbove && !endAbove) { - // This boundary edge is the start point for a contour line, - // so follow the line. - contour.push_back(ContourLine()); - ContourLine& contour_line = contour.back(); - TriEdge tri_edge = *itb; - follow_interior(contour_line, tri_edge, true, level, false); - } - } - } -} - -void TriContourGenerator::find_boundary_lines_filled(Contour& contour, - const double& lower_level, - const double& upper_level) -{ - // Traverse boundaries to find starting points for all contour lines that - // intersect the boundaries. For each starting point found, follow the - // line to its end before continuing. - const Triangulation& triang = _triangulation; - const Boundaries& boundaries = get_boundaries(); - for (Boundaries::size_type i = 0; i < boundaries.size(); ++i) { - const Boundary& boundary = boundaries[i]; - for (Boundary::size_type j = 0; j < boundary.size(); ++j) { - if (!_boundaries_visited[i][j]) { - // z values of start and end of this boundary edge. - double z_start = get_z(triang.get_triangle_point(boundary[j])); - double z_end = get_z(triang.get_triangle_point( - boundary[j].tri, (boundary[j].edge+1)%3)); - - // Does this boundary edge's z increase through upper level - // and/or decrease through lower level? - bool incr_upper = (z_start < upper_level && z_end >= upper_level); - bool decr_lower = (z_start >= lower_level && z_end < lower_level); - - if (decr_lower || incr_upper) { - // Start point for contour line, so follow it. - contour.push_back(ContourLine()); - ContourLine& contour_line = contour.back(); - TriEdge start_tri_edge = boundary[j]; - TriEdge tri_edge = start_tri_edge; - - // Traverse interior and boundaries until return to start. - bool on_upper = incr_upper; - do { - follow_interior(contour_line, tri_edge, true, - on_upper ? upper_level : lower_level, on_upper); - on_upper = follow_boundary(contour_line, tri_edge, - lower_level, upper_level, on_upper); - } while (tri_edge != start_tri_edge); - - // Close polygon. - contour_line.push_back(contour_line.front()); - } - } - } - } - - // Add full boundaries that lie between the lower and upper levels. These - // are boundaries that have not been touched by an internal contour line - // which are stored in _boundaries_used. - for (Boundaries::size_type i = 0; i < boundaries.size(); ++i) { - if (!_boundaries_used[i]) { - const Boundary& boundary = boundaries[i]; - double z = get_z(triang.get_triangle_point(boundary[0])); - if (z >= lower_level && z < upper_level) { - contour.push_back(ContourLine()); - ContourLine& contour_line = contour.back(); - for (Boundary::size_type j = 0; j < boundary.size(); ++j) - contour_line.push_back(triang.get_point_coords( - triang.get_triangle_point(boundary[j]))); - - // Close polygon. - contour_line.push_back(contour_line.front()); - } - } - } -} - -void TriContourGenerator::find_interior_lines(Contour& contour, - const double& level, - bool on_upper, - bool filled) -{ - const Triangulation& triang = _triangulation; - int ntri = triang.get_ntri(); - for (int tri = 0; tri < ntri; ++tri) { - int visited_index = (on_upper ? tri+ntri : tri); - - if (_interior_visited[visited_index] || triang.is_masked(tri)) - continue; // Triangle has already been visited or is masked. - - _interior_visited[visited_index] = true; - - // Determine edge via which to leave this triangle. - int edge = get_exit_edge(tri, level, on_upper); - assert(edge >= -1 && edge < 3 && "Invalid exit edge"); - if (edge == -1) - continue; // Contour does not pass through this triangle. - - // Found start of new contour line loop. - contour.push_back(ContourLine()); - ContourLine& contour_line = contour.back(); - TriEdge tri_edge = triang.get_neighbor_edge(tri, edge); - follow_interior(contour_line, tri_edge, false, level, on_upper); - - // Close line loop - contour_line.push_back(contour_line.front()); - } -} - -bool TriContourGenerator::follow_boundary(ContourLine& contour_line, - TriEdge& tri_edge, - const double& lower_level, - const double& upper_level, - bool on_upper) -{ - const Triangulation& triang = _triangulation; - const Boundaries& boundaries = get_boundaries(); - - // Have TriEdge to start at, need equivalent boundary edge. - int boundary, edge; - triang.get_boundary_edge(tri_edge, boundary, edge); - _boundaries_used[boundary] = true; - - bool stop = false; - bool first_edge = true; - double z_start, z_end = 0; - while (!stop) - { - assert(!_boundaries_visited[boundary][edge] && "Boundary already visited"); - _boundaries_visited[boundary][edge] = true; - - // z values of start and end points of boundary edge. - if (first_edge) - z_start = get_z(triang.get_triangle_point(tri_edge)); - else - z_start = z_end; - z_end = get_z(triang.get_triangle_point(tri_edge.tri, - (tri_edge.edge+1)%3)); - - if (z_end > z_start) { // z increasing. - if (!(!on_upper && first_edge) && - z_end >= lower_level && z_start < lower_level) { - stop = true; - on_upper = false; - } else if (z_end >= upper_level && z_start < upper_level) { - stop = true; - on_upper = true; - } - } else { // z decreasing. - if (!(on_upper && first_edge) && - z_start >= upper_level && z_end < upper_level) { - stop = true; - on_upper = true; - } else if (z_start >= lower_level && z_end < lower_level) { - stop = true; - on_upper = false; - } - } - - first_edge = false; - - if (!stop) { - // Move to next boundary edge, adding point to contour line. - edge = (edge+1) % (int)boundaries[boundary].size(); - tri_edge = boundaries[boundary][edge]; - contour_line.push_back(triang.get_point_coords( - triang.get_triangle_point(tri_edge))); - } - } - - return on_upper; -} - -void TriContourGenerator::follow_interior(ContourLine& contour_line, - TriEdge& tri_edge, - bool end_on_boundary, - const double& level, - bool on_upper) -{ - int& tri = tri_edge.tri; - int& edge = tri_edge.edge; - - // Initial point. - contour_line.push_back(edge_interp(tri, edge, level)); - - while (true) { - int visited_index = tri; - if (on_upper) - visited_index += _triangulation.get_ntri(); - - // Check for end not on boundary. - if (!end_on_boundary && _interior_visited[visited_index]) - break; // Reached start point, so return. - - // Determine edge by which to leave this triangle. - edge = get_exit_edge(tri, level, on_upper); - assert(edge >= 0 && edge < 3 && "Invalid exit edge"); - - _interior_visited[visited_index] = true; - - // Append new point to point set. - assert(edge >= 0 && edge < 3 && "Invalid triangle edge"); - contour_line.push_back(edge_interp(tri, edge, level)); - - // Move to next triangle. - TriEdge next_tri_edge = _triangulation.get_neighbor_edge(tri,edge); - - // Check if ending on a boundary. - if (end_on_boundary && next_tri_edge.tri == -1) - break; - - tri_edge = next_tri_edge; - assert(tri_edge.tri != -1 && "Invalid triangle for internal loop"); - } -} - -const TriContourGenerator::Boundaries& TriContourGenerator::get_boundaries() const -{ - return _triangulation.get_boundaries(); -} - -int TriContourGenerator::get_exit_edge(int tri, - const double& level, - bool on_upper) const -{ - assert(tri >= 0 && tri < _triangulation.get_ntri() && - "Triangle index out of bounds."); - - unsigned int config = - (get_z(_triangulation.get_triangle_point(tri, 0)) >= level) | - (get_z(_triangulation.get_triangle_point(tri, 1)) >= level) << 1 | - (get_z(_triangulation.get_triangle_point(tri, 2)) >= level) << 2; - - if (on_upper) config = 7-config; - - switch (config) { - case 0: return -1; - case 1: return 2; - case 2: return 0; - case 3: return 2; - case 4: return 1; - case 5: return 1; - case 6: return 0; - case 7: return -1; - default: assert(0 && "Invalid config value"); return -1; - } -} - -const double& TriContourGenerator::get_z(int point) const -{ - assert(point >= 0 && point < _triangulation.get_npoints() && - "Point index out of bounds."); - return _z.data()[point]; -} - -XY TriContourGenerator::interp(int point1, - int point2, - const double& level) const -{ - assert(point1 >= 0 && point1 < _triangulation.get_npoints() && - "Point index 1 out of bounds."); - assert(point2 >= 0 && point2 < _triangulation.get_npoints() && - "Point index 2 out of bounds."); - assert(point1 != point2 && "Identical points"); - double fraction = (get_z(point2) - level) / (get_z(point2) - get_z(point1)); - return _triangulation.get_point_coords(point1)*fraction + - _triangulation.get_point_coords(point2)*(1.0 - fraction); -} - - - -TrapezoidMapTriFinder::TrapezoidMapTriFinder(Triangulation& triangulation) - : _triangulation(triangulation), - _points(0), - _tree(0) -{} - -TrapezoidMapTriFinder::~TrapezoidMapTriFinder() -{ - clear(); -} - -bool -TrapezoidMapTriFinder::add_edge_to_tree(const Edge& edge) -{ - std::vector<Trapezoid*> trapezoids; - if (!find_trapezoids_intersecting_edge(edge, trapezoids)) - return false; - assert(!trapezoids.empty() && "No trapezoids intersect edge"); - - const Point* p = edge.left; - const Point* q = edge.right; - Trapezoid* left_old = 0; // old trapezoid to the left. - Trapezoid* left_below = 0; // below trapezoid to the left. - Trapezoid* left_above = 0; // above trapezoid to the left. - - // Iterate through trapezoids intersecting edge from left to right. - // Replace each old trapezoid with 2+ new trapezoids, and replace its - // corresponding nodes in the search tree with new nodes. - size_t ntraps = trapezoids.size(); - for (size_t i = 0; i < ntraps; ++i) { - Trapezoid* old = trapezoids[i]; // old trapezoid to replace. - bool start_trap = (i == 0); - bool end_trap = (i == ntraps-1); - bool have_left = (start_trap && edge.left != old->left); - bool have_right = (end_trap && edge.right != old->right); - - // Old trapezoid is replaced by up to 4 new trapezoids: left is to the - // left of the start point p, below/above are below/above the edge - // inserted, and right is to the right of the end point q. - Trapezoid* left = 0; - Trapezoid* below = 0; - Trapezoid* above = 0; - Trapezoid* right = 0; - - // There are 4 different cases here depending on whether the old - // trapezoid in question is the start and/or end trapezoid of those - // that intersect the edge inserted. There is some code duplication - // here but it is much easier to understand this way rather than - // interleave the 4 different cases with many more if-statements. - if (start_trap && end_trap) { - // Edge intersects a single trapezoid. - if (have_left) - left = new Trapezoid(old->left, p, old->below, old->above); - below = new Trapezoid(p, q, old->below, edge); - above = new Trapezoid(p, q, edge, old->above); - if (have_right) - right = new Trapezoid(q, old->right, old->below, old->above); - - // Set pairs of trapezoid neighbours. - if (have_left) { - left->set_lower_left(old->lower_left); - left->set_upper_left(old->upper_left); - left->set_lower_right(below); - left->set_upper_right(above); - } - else { - below->set_lower_left(old->lower_left); - above->set_upper_left(old->upper_left); - } - - if (have_right) { - right->set_lower_right(old->lower_right); - right->set_upper_right(old->upper_right); - below->set_lower_right(right); - above->set_upper_right(right); - } - else { - below->set_lower_right(old->lower_right); - above->set_upper_right(old->upper_right); - } - } - else if (start_trap) { - // Old trapezoid is the first of 2+ trapezoids that the edge - // intersects. - if (have_left) - left = new Trapezoid(old->left, p, old->below, old->above); - below = new Trapezoid(p, old->right, old->below, edge); - above = new Trapezoid(p, old->right, edge, old->above); - - // Set pairs of trapezoid neighbours. - if (have_left) { - left->set_lower_left(old->lower_left); - left->set_upper_left(old->upper_left); - left->set_lower_right(below); - left->set_upper_right(above); - } - else { - below->set_lower_left(old->lower_left); - above->set_upper_left(old->upper_left); - } - - below->set_lower_right(old->lower_right); - above->set_upper_right(old->upper_right); - } - else if (end_trap) { - // Old trapezoid is the last of 2+ trapezoids that the edge - // intersects. - if (left_below->below == old->below) { - below = left_below; - below->right = q; - } - else - below = new Trapezoid(old->left, q, old->below, edge); - - if (left_above->above == old->above) { - above = left_above; - above->right = q; - } - else - above = new Trapezoid(old->left, q, edge, old->above); - - if (have_right) - right = new Trapezoid(q, old->right, old->below, old->above); - - // Set pairs of trapezoid neighbours. - if (have_right) { - right->set_lower_right(old->lower_right); - right->set_upper_right(old->upper_right); - below->set_lower_right(right); - above->set_upper_right(right); - } - else { - below->set_lower_right(old->lower_right); - above->set_upper_right(old->upper_right); - } - - // Connect to new trapezoids replacing prevOld. - if (below != left_below) { - below->set_upper_left(left_below); - if (old->lower_left == left_old) - below->set_lower_left(left_below); - else - below->set_lower_left(old->lower_left); - } - - if (above != left_above) { - above->set_lower_left(left_above); - if (old->upper_left == left_old) - above->set_upper_left(left_above); - else - above->set_upper_left(old->upper_left); - } - } - else { // Middle trapezoid. - // Old trapezoid is neither the first nor last of the 3+ trapezoids - // that the edge intersects. - if (left_below->below == old->below) { - below = left_below; - below->right = old->right; - } - else - below = new Trapezoid(old->left, old->right, old->below, edge); - - if (left_above->above == old->above) { - above = left_above; - above->right = old->right; - } - else - above = new Trapezoid(old->left, old->right, edge, old->above); - - // Connect to new trapezoids replacing prevOld. - if (below != left_below) { // below is new. - below->set_upper_left(left_below); - if (old->lower_left == left_old) - below->set_lower_left(left_below); - else - below->set_lower_left(old->lower_left); - } - - if (above != left_above) { // above is new. - above->set_lower_left(left_above); - if (old->upper_left == left_old) - above->set_upper_left(left_above); - else - above->set_upper_left(old->upper_left); - } - - below->set_lower_right(old->lower_right); - above->set_upper_right(old->upper_right); - } - - // Create new nodes to add to search tree. Below and above trapezoids - // may already have owning trapezoid nodes, in which case reuse them. - Node* new_top_node = new Node( - &edge, - below == left_below ? below->trapezoid_node : new Node(below), - above == left_above ? above->trapezoid_node : new Node(above)); - if (have_right) - new_top_node = new Node(q, new_top_node, new Node(right)); - if (have_left) - new_top_node = new Node(p, new Node(left), new_top_node); - - // Insert new_top_node in correct position or positions in search tree. - Node* old_node = old->trapezoid_node; - if (old_node == _tree) - _tree = new_top_node; - else - old_node->replace_with(new_top_node); - - // old_node has been removed from all of its parents and is no longer - // needed. - assert(old_node->has_no_parents() && "Node should have no parents"); - delete old_node; - - // Clearing up. - if (!end_trap) { - // Prepare for next loop. - left_old = old; - left_above = above; - left_below = below; - } - } - - return true; -} - -void -TrapezoidMapTriFinder::clear() -{ - delete [] _points; - _points = 0; - - _edges.clear(); - - delete _tree; - _tree = 0; -} - -TrapezoidMapTriFinder::TriIndexArray -TrapezoidMapTriFinder::find_many(const CoordinateArray& x, - const CoordinateArray& y) -{ - if (x.ndim() != 1 || x.shape(0) != y.shape(0)) - throw std::invalid_argument( - "x and y must be array-like with same shape"); - - // Create integer array to return. - auto n = x.shape(0); - TriIndexArray tri_indices_array(n); - auto tri_indices = tri_indices_array.mutable_unchecked<1>(); - auto x_data = x.data(); - auto y_data = y.data(); - - // Fill returned array. - for (py::ssize_t i = 0; i < n; ++i) - tri_indices(i) = find_one(XY(x_data[i], y_data[i])); - - return tri_indices_array; -} - -int -TrapezoidMapTriFinder::find_one(const XY& xy) -{ - const Node* node = _tree->search(xy); - assert(node != 0 && "Search tree for point returned null node"); - return node->get_tri(); -} - -bool -TrapezoidMapTriFinder::find_trapezoids_intersecting_edge( - const Edge& edge, - std::vector<Trapezoid*>& trapezoids) -{ - // This is the FollowSegment algorithm of de Berg et al, with some extra - // checks to deal with simple colinear (i.e. invalid) triangles. - trapezoids.clear(); - Trapezoid* trapezoid = _tree->search(edge); - if (trapezoid == 0) { - assert(trapezoid != 0 && "search(edge) returns null trapezoid"); - return false; - } - - trapezoids.push_back(trapezoid); - while (edge.right->is_right_of(*trapezoid->right)) { - int orient = edge.get_point_orientation(*trapezoid->right); - if (orient == 0) { - if (edge.point_below == trapezoid->right) - orient = +1; - else if (edge.point_above == trapezoid->right) - orient = -1; - else { - assert(0 && "Unable to deal with point on edge"); - return false; - } - } - - if (orient == -1) - trapezoid = trapezoid->lower_right; - else if (orient == +1) - trapezoid = trapezoid->upper_right; - - if (trapezoid == 0) { - assert(0 && "Expected trapezoid neighbor"); - return false; - } - trapezoids.push_back(trapezoid); - } - - return true; -} - -py::list -TrapezoidMapTriFinder::get_tree_stats() -{ - NodeStats stats; - _tree->get_stats(0, stats); - - py::list ret(7); - ret[0] = stats.node_count; - ret[1] = stats.unique_nodes.size(), - ret[2] = stats.trapezoid_count, - ret[3] = stats.unique_trapezoid_nodes.size(), - ret[4] = stats.max_parent_count, - ret[5] = stats.max_depth, - ret[6] = stats.sum_trapezoid_depth / stats.trapezoid_count; - return ret; -} - -void -TrapezoidMapTriFinder::initialize() -{ - clear(); - const Triangulation& triang = _triangulation; - - // Set up points array, which contains all of the points in the - // triangulation plus the 4 corners of the enclosing rectangle. - int npoints = triang.get_npoints(); - _points = new Point[npoints + 4]; - BoundingBox bbox; - for (int i = 0; i < npoints; ++i) { - XY xy = triang.get_point_coords(i); - // Avoid problems with -0.0 values different from 0.0 - if (xy.x == -0.0) - xy.x = 0.0; - if (xy.y == -0.0) - xy.y = 0.0; - _points[i] = Point(xy); - bbox.add(xy); - } - - // Last 4 points are corner points of enclosing rectangle. Enclosing - // rectangle made slightly larger in case corner points are already in the - // triangulation. - if (bbox.empty) { - bbox.add(XY(0.0, 0.0)); - bbox.add(XY(1.0, 1.0)); - } - else { - const double small = 0.1; // Any value > 0.0 - bbox.expand( (bbox.upper - bbox.lower)*small ); - } - _points[npoints ] = Point(bbox.lower); // SW point. - _points[npoints+1] = Point(bbox.upper.x, bbox.lower.y); // SE point. - _points[npoints+2] = Point(bbox.lower.x, bbox.upper.y); // NW point. - _points[npoints+3] = Point(bbox.upper); // NE point. - - // Set up edges array. - // First the bottom and top edges of the enclosing rectangle. - _edges.push_back(Edge(&_points[npoints], &_points[npoints+1],-1,-1,0,0)); - _edges.push_back(Edge(&_points[npoints+2],&_points[npoints+3],-1,-1,0,0)); - - // Add all edges in the triangulation that point to the right. Do not - // explicitly include edges that point to the left as the neighboring - // triangle will supply that, unless there is no such neighbor. - int ntri = triang.get_ntri(); - for (int tri = 0; tri < ntri; ++tri) { - if (!triang.is_masked(tri)) { - for (int edge = 0; edge < 3; ++edge) { - Point* start = _points + triang.get_triangle_point(tri,edge); - Point* end = _points + - triang.get_triangle_point(tri,(edge+1)%3); - Point* other = _points + - triang.get_triangle_point(tri,(edge+2)%3); - TriEdge neighbor = triang.get_neighbor_edge(tri,edge); - if (end->is_right_of(*start)) { - const Point* neighbor_point_below = (neighbor.tri == -1) ? - 0 : _points + triang.get_triangle_point( - neighbor.tri, (neighbor.edge+2)%3); - _edges.push_back(Edge(start, end, neighbor.tri, tri, - neighbor_point_below, other)); - } - else if (neighbor.tri == -1) - _edges.push_back(Edge(end, start, tri, -1, other, 0)); - - // Set triangle associated with start point if not already set. - if (start->tri == -1) - start->tri = tri; - } - } - } - - // Initial trapezoid is enclosing rectangle. - _tree = new Node(new Trapezoid(&_points[npoints], &_points[npoints+1], - _edges[0], _edges[1])); - _tree->assert_valid(false); - - // Randomly shuffle all edges other than first 2. - std::mt19937 rng(1234); - std::shuffle(_edges.begin()+2, _edges.end(), rng); - - // Add edges, one at a time, to tree. - size_t nedges = _edges.size(); - for (size_t index = 2; index < nedges; ++index) { - if (!add_edge_to_tree(_edges[index])) - throw std::runtime_error("Triangulation is invalid"); - _tree->assert_valid(index == nedges-1); - } -} - -void -TrapezoidMapTriFinder::print_tree() -{ - assert(_tree != 0 && "Null Node tree"); - _tree->print(); -} - -TrapezoidMapTriFinder::Edge::Edge(const Point* left_, - const Point* right_, - int triangle_below_, - int triangle_above_, - const Point* point_below_, - const Point* point_above_) - : left(left_), - right(right_), - triangle_below(triangle_below_), - triangle_above(triangle_above_), - point_below(point_below_), - point_above(point_above_) -{ - assert(left != 0 && "Null left point"); - assert(right != 0 && "Null right point"); - assert(right->is_right_of(*left) && "Incorrect point order"); - assert(triangle_below >= -1 && "Invalid triangle below index"); - assert(triangle_above >= -1 && "Invalid triangle above index"); -} - -int -TrapezoidMapTriFinder::Edge::get_point_orientation(const XY& xy) const -{ - double cross_z = (xy - *left).cross_z(*right - *left); - return (cross_z > 0.0) ? +1 : ((cross_z < 0.0) ? -1 : 0); -} - -double -TrapezoidMapTriFinder::Edge::get_slope() const -{ - // Divide by zero is acceptable here. - XY diff = *right - *left; - return diff.y / diff.x; -} - -double -TrapezoidMapTriFinder::Edge::get_y_at_x(const double& x) const -{ - if (left->x == right->x) { - // If edge is vertical, return lowest y from left point. - assert(x == left->x && "x outside of edge"); - return left->y; - } - else { - // Equation of line: left + lambda*(right - left) = xy. - // i.e. left.x + lambda(right.x - left.x) = x and similar for y. - double lambda = (x - left->x) / (right->x - left->x); - assert(lambda >= 0 && lambda <= 1.0 && "Lambda out of bounds"); - return left->y + lambda*(right->y - left->y); - } -} - -bool -TrapezoidMapTriFinder::Edge::has_point(const Point* point) const -{ - assert(point != 0 && "Null point"); - return (left == point || right == point); -} - -bool -TrapezoidMapTriFinder::Edge::operator==(const Edge& other) const -{ - return this == &other; -} - -void -TrapezoidMapTriFinder::Edge::print_debug() const -{ - std::cout << "Edge " << *this << " tri_below=" << triangle_below - << " tri_above=" << triangle_above << std::endl; -} - -TrapezoidMapTriFinder::Node::Node(const Point* point, Node* left, Node* right) - : _type(Type_XNode) -{ - assert(point != 0 && "Invalid point"); - assert(left != 0 && "Invalid left node"); - assert(right != 0 && "Invalid right node"); - _union.xnode.point = point; - _union.xnode.left = left; - _union.xnode.right = right; - left->add_parent(this); - right->add_parent(this); -} - -TrapezoidMapTriFinder::Node::Node(const Edge* edge, Node* below, Node* above) - : _type(Type_YNode) -{ - assert(edge != 0 && "Invalid edge"); - assert(below != 0 && "Invalid below node"); - assert(above != 0 && "Invalid above node"); - _union.ynode.edge = edge; - _union.ynode.below = below; - _union.ynode.above = above; - below->add_parent(this); - above->add_parent(this); -} - -TrapezoidMapTriFinder::Node::Node(Trapezoid* trapezoid) - : _type(Type_TrapezoidNode) -{ - assert(trapezoid != 0 && "Null Trapezoid"); - _union.trapezoid = trapezoid; - trapezoid->trapezoid_node = this; -} - -TrapezoidMapTriFinder::Node::~Node() -{ - switch (_type) { - case Type_XNode: - if (_union.xnode.left->remove_parent(this)) - delete _union.xnode.left; - if (_union.xnode.right->remove_parent(this)) - delete _union.xnode.right; - break; - case Type_YNode: - if (_union.ynode.below->remove_parent(this)) - delete _union.ynode.below; - if (_union.ynode.above->remove_parent(this)) - delete _union.ynode.above; - break; - case Type_TrapezoidNode: - delete _union.trapezoid; - break; - } -} - -void -TrapezoidMapTriFinder::Node::add_parent(Node* parent) -{ - assert(parent != 0 && "Null parent"); - assert(parent != this && "Cannot be parent of self"); - assert(!has_parent(parent) && "Parent already in collection"); - _parents.push_back(parent); -} - -void -TrapezoidMapTriFinder::Node::assert_valid(bool tree_complete) const -{ -#ifndef NDEBUG - // Check parents. - for (Parents::const_iterator it = _parents.begin(); - it != _parents.end(); ++it) { - Node* parent = *it; - assert(parent != this && "Cannot be parent of self"); - assert(parent->has_child(this) && "Parent missing child"); - } - - // Check children, and recurse. - switch (_type) { - case Type_XNode: - assert(_union.xnode.left != 0 && "Null left child"); - assert(_union.xnode.left->has_parent(this) && "Incorrect parent"); - assert(_union.xnode.right != 0 && "Null right child"); - assert(_union.xnode.right->has_parent(this) && "Incorrect parent"); - _union.xnode.left->assert_valid(tree_complete); - _union.xnode.right->assert_valid(tree_complete); - break; - case Type_YNode: - assert(_union.ynode.below != 0 && "Null below child"); - assert(_union.ynode.below->has_parent(this) && "Incorrect parent"); - assert(_union.ynode.above != 0 && "Null above child"); - assert(_union.ynode.above->has_parent(this) && "Incorrect parent"); - _union.ynode.below->assert_valid(tree_complete); - _union.ynode.above->assert_valid(tree_complete); - break; - case Type_TrapezoidNode: - assert(_union.trapezoid != 0 && "Null trapezoid"); - assert(_union.trapezoid->trapezoid_node == this && - "Incorrect trapezoid node"); - _union.trapezoid->assert_valid(tree_complete); - break; - } -#endif -} - -void -TrapezoidMapTriFinder::Node::get_stats(int depth, - NodeStats& stats) const -{ - stats.node_count++; - if (depth > stats.max_depth) - stats.max_depth = depth; - bool new_node = stats.unique_nodes.insert(this).second; - if (new_node) - stats.max_parent_count = std::max(stats.max_parent_count, - static_cast<long>(_parents.size())); - - switch (_type) { - case Type_XNode: - _union.xnode.left->get_stats(depth+1, stats); - _union.xnode.right->get_stats(depth+1, stats); - break; - case Type_YNode: - _union.ynode.below->get_stats(depth+1, stats); - _union.ynode.above->get_stats(depth+1, stats); - break; - default: // Type_TrapezoidNode: - stats.unique_trapezoid_nodes.insert(this); - stats.trapezoid_count++; - stats.sum_trapezoid_depth += depth; - break; - } -} - -int -TrapezoidMapTriFinder::Node::get_tri() const -{ - switch (_type) { - case Type_XNode: - return _union.xnode.point->tri; - case Type_YNode: - if (_union.ynode.edge->triangle_above != -1) - return _union.ynode.edge->triangle_above; - else - return _union.ynode.edge->triangle_below; - default: // Type_TrapezoidNode: - assert(_union.trapezoid->below.triangle_above == - _union.trapezoid->above.triangle_below && - "Inconsistent triangle indices from trapezoid edges"); - return _union.trapezoid->below.triangle_above; - } -} - -bool -TrapezoidMapTriFinder::Node::has_child(const Node* child) const -{ - assert(child != 0 && "Null child node"); - switch (_type) { - case Type_XNode: - return (_union.xnode.left == child || _union.xnode.right == child); - case Type_YNode: - return (_union.ynode.below == child || - _union.ynode.above == child); - default: // Type_TrapezoidNode: - return false; - } -} - -bool -TrapezoidMapTriFinder::Node::has_no_parents() const -{ - return _parents.empty(); -} - -bool -TrapezoidMapTriFinder::Node::has_parent(const Node* parent) const -{ - return (std::find(_parents.begin(), _parents.end(), parent) != - _parents.end()); -} - -void -TrapezoidMapTriFinder::Node::print(int depth /* = 0 */) const -{ - for (int i = 0; i < depth; ++i) std::cout << " "; - switch (_type) { - case Type_XNode: - std::cout << "XNode " << *_union.xnode.point << std::endl; - _union.xnode.left->print(depth + 1); - _union.xnode.right->print(depth + 1); - break; - case Type_YNode: - std::cout << "YNode " << *_union.ynode.edge << std::endl; - _union.ynode.below->print(depth + 1); - _union.ynode.above->print(depth + 1); - break; - case Type_TrapezoidNode: - std::cout << "Trapezoid ll=" - << _union.trapezoid->get_lower_left_point() << " lr=" - << _union.trapezoid->get_lower_right_point() << " ul=" - << _union.trapezoid->get_upper_left_point() << " ur=" - << _union.trapezoid->get_upper_right_point() << std::endl; - break; - } -} - -bool -TrapezoidMapTriFinder::Node::remove_parent(Node* parent) -{ - assert(parent != 0 && "Null parent"); - assert(parent != this && "Cannot be parent of self"); - Parents::iterator it = std::find(_parents.begin(), _parents.end(), parent); - assert(it != _parents.end() && "Parent not in collection"); - _parents.erase(it); - return _parents.empty(); -} - -void -TrapezoidMapTriFinder::Node::replace_child(Node* old_child, Node* new_child) -{ - switch (_type) { - case Type_XNode: - assert((_union.xnode.left == old_child || - _union.xnode.right == old_child) && "Not a child Node"); - assert(new_child != 0 && "Null child node"); - if (_union.xnode.left == old_child) - _union.xnode.left = new_child; - else - _union.xnode.right = new_child; - break; - case Type_YNode: - assert((_union.ynode.below == old_child || - _union.ynode.above == old_child) && "Not a child node"); - assert(new_child != 0 && "Null child node"); - if (_union.ynode.below == old_child) - _union.ynode.below = new_child; - else - _union.ynode.above = new_child; - break; - case Type_TrapezoidNode: - assert(0 && "Invalid type for this operation"); - break; - } - old_child->remove_parent(this); - new_child->add_parent(this); -} - -void -TrapezoidMapTriFinder::Node::replace_with(Node* new_node) -{ - assert(new_node != 0 && "Null replacement node"); - // Replace child of each parent with new_node. As each has parent has its - // child replaced it is removed from the _parents collection. - while (!_parents.empty()) - _parents.front()->replace_child(this, new_node); -} - -const TrapezoidMapTriFinder::Node* -TrapezoidMapTriFinder::Node::search(const XY& xy) -{ - switch (_type) { - case Type_XNode: - if (xy == *_union.xnode.point) - return this; - else if (xy.is_right_of(*_union.xnode.point)) - return _union.xnode.right->search(xy); - else - return _union.xnode.left->search(xy); - case Type_YNode: { - int orient = _union.ynode.edge->get_point_orientation(xy); - if (orient == 0) - return this; - else if (orient < 0) - return _union.ynode.above->search(xy); - else - return _union.ynode.below->search(xy); - } - default: // Type_TrapezoidNode: - return this; - } -} - -TrapezoidMapTriFinder::Trapezoid* -TrapezoidMapTriFinder::Node::search(const Edge& edge) -{ - switch (_type) { - case Type_XNode: - if (edge.left == _union.xnode.point) - return _union.xnode.right->search(edge); - else { - if (edge.left->is_right_of(*_union.xnode.point)) - return _union.xnode.right->search(edge); - else - return _union.xnode.left->search(edge); - } - case Type_YNode: - if (edge.left == _union.ynode.edge->left) { - // Coinciding left edge points. - if (edge.get_slope() == _union.ynode.edge->get_slope()) { - if (_union.ynode.edge->triangle_above == - edge.triangle_below) - return _union.ynode.above->search(edge); - else if (_union.ynode.edge->triangle_below == - edge.triangle_above) - return _union.ynode.below->search(edge); - else { - assert(0 && - "Invalid triangulation, common left points"); - return 0; - } - } - if (edge.get_slope() > _union.ynode.edge->get_slope()) - return _union.ynode.above->search(edge); - else - return _union.ynode.below->search(edge); - } - else if (edge.right == _union.ynode.edge->right) { - // Coinciding right edge points. - if (edge.get_slope() == _union.ynode.edge->get_slope()) { - if (_union.ynode.edge->triangle_above == - edge.triangle_below) - return _union.ynode.above->search(edge); - else if (_union.ynode.edge->triangle_below == - edge.triangle_above) - return _union.ynode.below->search(edge); - else { - assert(0 && - "Invalid triangulation, common right points"); - return 0; - } - } - if (edge.get_slope() > _union.ynode.edge->get_slope()) - return _union.ynode.below->search(edge); - else - return _union.ynode.above->search(edge); - } - else { - int orient = - _union.ynode.edge->get_point_orientation(*edge.left); - if (orient == 0) { - // edge.left lies on _union.ynode.edge - if (_union.ynode.edge->point_above != 0 && - edge.has_point(_union.ynode.edge->point_above)) - orient = -1; - else if (_union.ynode.edge->point_below != 0 && - edge.has_point(_union.ynode.edge->point_below)) - orient = +1; - else { - assert(0 && "Invalid triangulation, point on edge"); - return 0; - } - } - if (orient < 0) - return _union.ynode.above->search(edge); - else - return _union.ynode.below->search(edge); - } - default: // Type_TrapezoidNode: - return _union.trapezoid; - } -} - -TrapezoidMapTriFinder::Trapezoid::Trapezoid(const Point* left_, - const Point* right_, - const Edge& below_, - const Edge& above_) - : left(left_), right(right_), below(below_), above(above_), - lower_left(0), lower_right(0), upper_left(0), upper_right(0), - trapezoid_node(0) -{ - assert(left != 0 && "Null left point"); - assert(right != 0 && "Null right point"); - assert(right->is_right_of(*left) && "Incorrect point order"); -} - -void -TrapezoidMapTriFinder::Trapezoid::assert_valid(bool tree_complete) const -{ -#ifndef NDEBUG - assert(left != 0 && "Null left point"); - assert(right != 0 && "Null right point"); - - if (lower_left != 0) { - assert(lower_left->below == below && - lower_left->lower_right == this && - "Incorrect lower_left trapezoid"); - assert(get_lower_left_point() == lower_left->get_lower_right_point() && - "Incorrect lower left point"); - } - - if (lower_right != 0) { - assert(lower_right->below == below && - lower_right->lower_left == this && - "Incorrect lower_right trapezoid"); - assert(get_lower_right_point() == lower_right->get_lower_left_point() && - "Incorrect lower right point"); - } - - if (upper_left != 0) { - assert(upper_left->above == above && - upper_left->upper_right == this && - "Incorrect upper_left trapezoid"); - assert(get_upper_left_point() == upper_left->get_upper_right_point() && - "Incorrect upper left point"); - } - - if (upper_right != 0) { - assert(upper_right->above == above && - upper_right->upper_left == this && - "Incorrect upper_right trapezoid"); - assert(get_upper_right_point() == upper_right->get_upper_left_point() && - "Incorrect upper right point"); - } - - assert(trapezoid_node != 0 && "Null trapezoid_node"); - - if (tree_complete) { - assert(below.triangle_above == above.triangle_below && - "Inconsistent triangle indices from trapezoid edges"); - } -#endif -} - -XY -TrapezoidMapTriFinder::Trapezoid::get_lower_left_point() const -{ - double x = left->x; - return XY(x, below.get_y_at_x(x)); -} - -XY -TrapezoidMapTriFinder::Trapezoid::get_lower_right_point() const -{ - double x = right->x; - return XY(x, below.get_y_at_x(x)); -} - -XY -TrapezoidMapTriFinder::Trapezoid::get_upper_left_point() const -{ - double x = left->x; - return XY(x, above.get_y_at_x(x)); -} - -XY -TrapezoidMapTriFinder::Trapezoid::get_upper_right_point() const -{ - double x = right->x; - return XY(x, above.get_y_at_x(x)); -} - -void -TrapezoidMapTriFinder::Trapezoid::print_debug() const -{ - std::cout << "Trapezoid " << this - << " left=" << *left - << " right=" << *right - << " below=" << below - << " above=" << above - << " ll=" << lower_left - << " lr=" << lower_right - << " ul=" << upper_left - << " ur=" << upper_right - << " node=" << trapezoid_node - << " llp=" << get_lower_left_point() - << " lrp=" << get_lower_right_point() - << " ulp=" << get_upper_left_point() - << " urp=" << get_upper_right_point() << std::endl; -} - -void -TrapezoidMapTriFinder::Trapezoid::set_lower_left(Trapezoid* lower_left_) -{ - lower_left = lower_left_; - if (lower_left != 0) - lower_left->lower_right = this; -} - -void -TrapezoidMapTriFinder::Trapezoid::set_lower_right(Trapezoid* lower_right_) -{ - lower_right = lower_right_; - if (lower_right != 0) - lower_right->lower_left = this; -} - -void -TrapezoidMapTriFinder::Trapezoid::set_upper_left(Trapezoid* upper_left_) -{ - upper_left = upper_left_; - if (upper_left != 0) - upper_left->upper_right = this; -} - -void -TrapezoidMapTriFinder::Trapezoid::set_upper_right(Trapezoid* upper_right_) -{ - upper_right = upper_right_; - if (upper_right != 0) - upper_right->upper_left = this; -} |