/******************************************************************************** * * * This file is part of IfcOpenShell. * * * * IfcOpenShell is free software: you can redistribute it and/or modify * * it under the terms of the Lesser GNU General Public License as published by * * the Free Software Foundation, either version 3.0 of the License, or * * (at your option) any later version. * * * * IfcOpenShell is distributed in the hope that it will be useful, * * but WITHOUT ANY WARRANTY; without even the implied warranty of * * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * * Lesser GNU General Public License for more details. * * * * You should have received a copy of the Lesser GNU General Public License * * along with this program. If not, see . * * * ********************************************************************************/ #define _USE_MATH_DEFINES #include #include "CgalKernel.h" #include "../../../ifcparse/logger.h" #include "../../../ifcgeom/kernels/cgal/CgalConversionResult.h" #ifdef IFOPSH_SIMPLE_KERNEL #define CgalShape SimpleCgalShape #endif #include #include #include #include #include #include #include #include using namespace IfcGeom; using namespace ifcopenshell::geometry; using namespace ifcopenshell::geometry::kernels; namespace { struct PolyhedronBuilder : public CGAL::Modifier_base::HalfedgeDS> { private: std::list *face_list; public: std::optional from_soup; PolyhedronBuilder(std::list *face_list); void operator()(CGAL::Polyhedron_3::HalfedgeDS &hds); }; } CGAL::Polyhedron_3 ifcopenshell::geometry::utils::create_polyhedron(std::list &face_list, bool stitch_borders) { // Naive creation CGAL::Polyhedron_3 polyhedron; PolyhedronBuilder builder(&face_list); polyhedron.delegate(builder); if (builder.from_soup) { polyhedron = *builder.from_soup; } // Stitch edges // std::cout << "Before: " << polyhedron.size_of_vertices() << " vertices and " << polyhedron.size_of_facets() << " facets" << std::endl; if (stitch_borders) { // we have a map of points now in the builder, it's maybe not necessary anymore to stitch_borders? // size_t ne = polyhedron.size_of_border_edges(); CGAL::Polygon_mesh_processing::stitch_borders(polyhedron); // size_t ne2 = polyhedron.size_of_border_edges(); // std::wcout << (ne - ne2) << " removed" << std::endl; } polyhedron.normalize_border(); if (!polyhedron.is_valid(false, 1)) { logger::message(logger::LOG_ERROR, "create_polyhedron: Polyhedron not valid!"); // std::ofstream fresult; // fresult.open("/Users/ken/Desktop/invalid.off"); // fresult << polyhedron << std::endl; // fresult.close(); return CGAL::Polyhedron_3(); } // std::cout << "After: " << polyhedron.size_of_vertices() << " vertices and " << polyhedron.size_of_facets() << " facets" << std::endl; return polyhedron; } #ifndef IFOPSH_SIMPLE_KERNEL CGAL::Polyhedron_3 ifcopenshell::geometry::utils::create_polyhedron(const CGAL::Nef_polyhedron_3& nef_polyhedron) { if (nef_polyhedron.is_simple()) { try { CGAL::Polyhedron_3 polyhedron; nef_polyhedron.convert_to_polyhedron(polyhedron); return polyhedron; } catch (...) { logger::message(logger::LOG_ERROR, "Conversion from Nef to polyhedron failed!"); return CGAL::Polyhedron_3(); } } else { logger::message(logger::LOG_ERROR, "Nef polyhedron not simple: cannot create polyhedron!"); return CGAL::Polyhedron_3(); } } CGAL::Nef_polyhedron_3 ifcopenshell::geometry::utils::create_nef_polyhedron(std::list &face_list) { CGAL::Polyhedron_3 polyhedron = create_polyhedron(face_list); if (polyhedron.is_closed()) { try { if (!CGAL::Polygon_mesh_processing::is_outward_oriented(polyhedron)) { CGAL::Polygon_mesh_processing::reverse_face_orientations(polyhedron); } } catch (CGAL::Failure_exception& e) { logger::message(logger::LOG_ERROR, e); } } CGAL::Polygon_mesh_processing::triangulate_faces(polyhedron); CGAL::Nef_polyhedron_3 nef_polyhedron; try { nef_polyhedron = CGAL::Nef_polyhedron_3(polyhedron); } catch (...) { logger::message(logger::LOG_ERROR, "Conversion to Nef polyhedron failed!"); } return nef_polyhedron; } CGAL::Nef_polyhedron_3 ifcopenshell::geometry::utils::create_nef_polyhedron(CGAL::Polyhedron_3 &polyhedron) { // @todo needed? polyhedron.normalize_border(); if (polyhedron.is_closed()) { try { if (!CGAL::Polygon_mesh_processing::is_outward_oriented(polyhedron)) { CGAL::Polygon_mesh_processing::reverse_face_orientations(polyhedron); } } catch (CGAL::Failure_exception& e) { logger::message(logger::LOG_ERROR, e); } } if (polyhedron.is_valid(false, 3) && polyhedron.is_closed()) { // @todo is it necessary to triangulat? CGAL::Polygon_mesh_processing::triangulate_faces(polyhedron); CGAL::Nef_polyhedron_3 nef_polyhedron; try { nef_polyhedron = CGAL::Nef_polyhedron_3(polyhedron); } catch (...) { logger::message(logger::LOG_ERROR, "Conversion to Nef polyhedron failed!"); } return nef_polyhedron; } else { logger::message(logger::LOG_ERROR, "Polyhedron not valid: cannot create Nef polyhedron!"); return CGAL::Nef_polyhedron_3(); } } #endif bool CgalKernel::convert(const taxonomy::shell::ptr l, cgal_shape_t& shape) { for (auto& f : l->children) { if (f->basis && f->basis->kind() != taxonomy::PLANE) { logger::error("CGAL Kernel: Non-planar faces not supported at the moment"); throw not_supported_error(); } for (auto& w : f->children) { for (auto& e : w->children) { if (e->basis && e->basis->kind() == taxonomy::BSPLINE_CURVE) { logger::error("CGAL Kernel: B-spline edge curves not supported at the moment"); throw not_supported_error(); } } } } if (false && l->children.size() > 100) { static double inf = 1.e9; // std::numeric_limits::infinity(); std::pair minmax( Eigen::Vector3d(+inf, +inf, +inf), Eigen::Vector3d(-inf, -inf, -inf) ); size_t num_points = 0; visit_2(l, [&minmax, &num_points](const taxonomy::point3::ptr p) { auto& c = p->ccomponents(); ++num_points; for (int i = 0; i < 3; ++i) { if (c(i) < minmax.first(i)) { minmax.first(i) = c(i); } if (c(i) > minmax.second(i)) { minmax.second(i) = c(i); } } }); auto diag = minmax.second - minmax.first; double volume = diag(0) * diag(1) * diag(2); // @todo volume van be zero also.. double density = num_points / volume; logger::notice("Density " + boost::lexical_cast(density), l->instance); if (density > 5000) { logger::notice("Substituted element with " + boost::lexical_cast(density) + " vertices / m3 with a bounding box"); CGAL::Point_3 lower(minmax.first(0), minmax.first(1), minmax.first(2)); CGAL::Point_3 upper(minmax.second(0), minmax.second(1), minmax.second(2)); shape = utils::create_cube(lower, upper); return true; } } std::list face_list; for (auto& f : l->children) { bool success = false; try { success = convert(f, face_list); } catch (...) {} if (!success) { if (this->partial_success_is_success) { logger::message(logger::LOG_WARNING, "Failed to convert face, skipping:", f->instance); continue; } else { logger::message(logger::LOG_ERROR, "Failed to convert face:", f->instance); return false; } } // std::cout << "Face in ConnectedFaceSet: " << std::endl; // for (auto &point: face.outer) { // std::cout << "\tPoint(" << point << ")" << std::endl; // } } shape = utils::create_polyhedron(face_list); return shape.size_of_facets(); } bool CgalKernel::convert(const taxonomy::face::ptr face, std::list& result) { int num_outer_bounds = 0; for (auto& bound : face->children) { if (bound->external.value_or(false)) num_outer_bounds++; } if (face->children.size() > 1 && num_outer_bounds > 1 && face->children.size() != num_outer_bounds) { logger::message(logger::LOG_ERROR, "Invalid configuration of boundaries for:", face->instance); return false; } cgal_face_t mf; for (auto& bound : face->children) { const bool is_interior = !(bound->external.value_or(false) || face->children.size() == 1); // single face bound is always external... even if not marked as such cgal_wire_t wire; if (!convert(bound, wire)) { logger::message(logger::LOG_ERROR, "Failed to process face boundary loop", bound->instance); return false; } if (!is_interior) { mf.outer = wire; } else { mf.inner.push_back(wire); } if (num_outer_bounds > 1) { result.push_back(mf); mf = cgal_face_t{}; } } if (num_outer_bounds == 1 || face->children.size() == 1) { result.push_back(mf); } // std::cout << "Face: " << std::endl; // for (auto &point: face.outer) { // std::cout << "\tPoint(" << point << ")" << std::endl; // } return true; } namespace { // @todo obsolete? /* bool convert_curve(CgalKernel* kernel, const taxonomy::ptr curve, cgal_wire_t& builder) { if (auto e = taxonomy::dcast(curve)) { if (true || e->basis == nullptr) { if (builder.empty()) { const auto& p = std::get(e->start); cgal_point_t pnt(p->ccomponents()(0), p->ccomponents()(1), p->ccomponents()(2)); builder.push_back(pnt); } const auto& p = std::get(e->end); cgal_point_t pnt(p->ccomponents()(0), p->ccomponents()(1), p->ccomponents()(2)); builder.push_back(pnt); } else if (e->basis->kind() == taxonomy::CIRCLE) { // @todo } else if (e->basis->kind() == taxonomy::ELLIPSE) { // @todo } else { throw std::runtime_error("Not implemented basis kind"); } } else if (auto lp = taxonomy::dcast(curve)) { for (auto& c : lp->children) { convert_curve(kernel, c, builder); } } else { throw std::runtime_error("Not implemented curve"); } } */ } namespace { typedef std::pair parameter_range; static const parameter_range unbounded = { -std::numeric_limits::infinity(), +std::numeric_limits::infinity() }; void evaluate_curve(const taxonomy::line::ptr& c, double u, taxonomy::point3& p) { Eigen::Vector4d xy{ 0, 0, u, 1. }; p.components() = (c->matrix->ccomponents() * xy).head<3>(); } void evaluate_curve(const taxonomy::circle::ptr& c, double u, taxonomy::point3& p) { Eigen::Vector4d xy{ c->radius * std::cos(u), c->radius * std::sin(u), 0, 1. }; p.components() = (c->matrix->ccomponents() * xy).head<3>(); } void evaluate_curve(const taxonomy::ellipse::ptr& c, double u, taxonomy::point3& p) { Eigen::Vector4d xy{ c->radius * std::cos(u), c->radius2 * std::sin(u), 0, 1. }; p.components() = (c->matrix->ccomponents() * xy).head<3>(); } // ---- void project_onto_curve(const taxonomy::line::ptr& c, const taxonomy::point3& p, double& u) { u = (c->matrix->ccomponents().inverse() * p.ccomponents().homogeneous())(2); } void project_onto_curve(const taxonomy::circle::ptr& c, const taxonomy::point3& p, double& u) { Eigen::Vector2d xy = (c->matrix->ccomponents().inverse() * p.ccomponents().homogeneous()).head<2>(); u = std::atan2(xy(1), xy(0)); } void project_onto_curve(const taxonomy::ellipse::ptr& c, const taxonomy::point3& p, double& u) { Eigen::Vector2d xy = (c->matrix->ccomponents().inverse() * p.ccomponents().homogeneous()).head<2>(); u = std::atan2(xy(1), xy(0)); } struct point_projection_visitor_ { taxonomy::point3 p; double u; typedef void result_type; void operator()(const taxonomy::line::ptr& c) { project_onto_curve(c, p, u); } void operator()(const taxonomy::circle::ptr& c) { project_onto_curve(c, p, u); } void operator()(const taxonomy::ellipse::ptr& c) { project_onto_curve(c, p, u); } void operator()(const taxonomy::item::ptr&) { throw std::runtime_error("Point projection not implemented on this geometry type"); } }; struct point_projection_visitor { taxonomy::ptr curve; double u; typedef void result_type; void operator()(const boost::blank&) { throw std::runtime_error("Unbounded curve not supported here"); } void operator()(const taxonomy::point3::ptr& p) { point_projection_visitor_ v{ *p }; dispatch_curve_creation::dispatch(curve, v); u = v.u; } void operator()(const double& u) { this->u = u; } }; struct cgal_curve_creation_visitor { Settings& settings_; parameter_range param; std::vector points; cgal_curve_creation_visitor(Settings& s) : settings_(s), param(unbounded) {} cgal_curve_creation_visitor(Settings& s, const parameter_range& p) : settings_(s), param(p) {} void operator()(const taxonomy::line::ptr& l) { if (param == unbounded) { throw std::runtime_error("Cannot represent infinite line segment"); } taxonomy::point3 start, end; evaluate_curve(l, param.first, start); evaluate_curve(l, param.second, end); points.push_back(start); points.push_back(end); } template void evaluate_conic(const T& t) { double a, b; if (param == unbounded) { a = 0.; b = 2 * M_PI; } else { std::tie(a, b) = param; } a = std::fmod(a, 2 * M_PI); b = std::fmod(b, 2 * M_PI); if (b <= a) { b += 2 * M_PI; } int num_segments = (int)std::ceil(std::fabs(a - b) / (2 * M_PI) * settings_.get().get()); double du = (b - a) / num_segments; taxonomy::point3 P; // @nb for loop is not inclusive of the both end points evaluate_curve(t, a, P); points.push_back(P); for (int i = 1; i < num_segments; ++i) { double u = a + du * i; evaluate_curve(t, u, P); points.push_back(P); } evaluate_curve(t, b, P); points.push_back(P); } void operator()(const taxonomy::circle::ptr& c) { evaluate_conic(c); } void operator()(const taxonomy::ellipse::ptr& e) { evaluate_conic(e); } void operator()(const taxonomy::trimmed_curve::ptr& e) { auto e_basis = e->basis; while (e_basis->kind() == taxonomy::EDGE && e_basis->instance && e_basis->instance.declaration().name() == "IfcTrimmedCurve") { // @todo we still might have something to wrt orientation on periodic curves // to make sure we select the correct arc later on. e_basis = taxonomy::cast(e_basis)->basis; } point_projection_visitor v1{ e->basis }, v2{ e->basis }; std::visit(v1, e->start); std::visit(v2, e->end); if (!e->curve_sense.value_or(true)) { std::swap(v1.u, v2.u); } cgal_curve_creation_visitor v(settings_, { v1.u, v2.u }); dispatch_curve_creation::dispatch(e->basis, v); this->points = v.points; if (!e->curve_sense.value_or(true)) { std::reverse(this->points.begin(), this->points.end()); } } void operator()(const taxonomy::edge::ptr& e) { return (*this)(taxonomy::dcast(e)); } void operator()(const taxonomy::item::ptr&) { throw std::runtime_error("Not supported"); } }; void convert_curve(Settings& s, taxonomy::ptr i, std::vector& points) { cgal_curve_creation_visitor v(s); dispatch_curve_creation::dispatch(i, v); points = v.points; } // @nb mutates a void extend_wire(std::vector& a, const std::vector& b) { if (a.empty()) { a = b; return; } if (b.empty()) { return; } double d = (a.back().ccomponents() - b.front().ccomponents()).norm(); size_t offset = d < 1.e-5 ? 1 : 0; a.insert(a.end(), b.begin() + offset, b.end()); } } #include #include #include #include typedef CGAL::Box_intersection_d::Box_with_handle_d Box; namespace { void loop_to_segments(const cgal_wire_t& wire, std::vector& segments) { for (int i = 0; i < wire.size(); ++i) { int j = (i + 1) % wire.size(); segments.emplace_back(wire[i], wire[j]); } } struct intersection_collector { const std::vector& segments; int num_self_intersections = 0; explicit intersection_collector(const std::vector& s) : segments(s) {} void operator()(const Box& a, const Box& b) { int aid = *a.handle(); int bid = *b.handle(); if (aid > bid) { std::swap(aid, bid); } if (((aid + 1) == bid) || ((aid == 0) && (bid = (segments.size() - 1)))) { // consecutive segments. return; } auto s0 = segments[aid]; auto s1 = segments[bid]; if (CGAL::do_intersect(s0, s1)) { num_self_intersections++; } } }; bool do_segments_intersect(const std::vector& segments) { std::vector boxes; std::vector handles(segments.size()); std::iota(handles.begin(), handles.end(), 0); for (auto it = segments.begin(); it != segments.end(); ++it) { boxes.push_back(Box(it->bbox(), &*(handles.begin() + std::distance(segments.begin(), it)))); } intersection_collector x(segments); CGAL::box_self_intersection_d(boxes.begin(), boxes.end(), x); return !!x.num_self_intersections; } } namespace { cgal_direction_t newell(const std::vector & loop) { Kernel_::FT a(0.0), b(0.0), c(0.0); for (size_t i = 0; i < loop.size(); ++i) { auto & curr = loop[i]; auto & next = loop[(i + 1) % loop.size()]; a += (curr.y() - next.y()) * (curr.z() + next.z()); b += (curr.z() - next.z()) * (curr.x() + next.x()); c += (curr.x() - next.x()) * (curr.y() + next.y()); } return cgal_direction_t(a, b, c); } } namespace { CGAL::Polygon_2 loop_to_polygon_2(taxonomy::loop::ptr loop) { CGAL::Polygon_2 polygon; for (auto& e : loop->children) { auto& p = *std::get(e->start); CGAL::Point_2 pnt(p.ccomponents()(0), p.ccomponents()(1)); polygon.push_back(pnt); } return polygon; } CGAL::Polygon_2 wire_to_polygon_2(const cgal_wire_t& w) { CGAL::Polygon_2 polygon; for (auto& p : w) { CGAL::Point_2 pnt(p.cartesian(0), p.cartesian(1)); polygon.push_back(pnt); } return polygon; } cgal_face_t wire_to_face(const cgal_wire_t& w) { cgal_face_t f; f.outer = w; return f; } class polygon_2_to_wire { private: const CGAL::Aff_transformation_3& t_; public: polygon_2_to_wire(const CGAL::Aff_transformation_3& t) : t_(t) {} cgal_wire_t operator()(const CGAL::Polygon_2& p) { cgal_wire_t w; for (auto it = p.vertices_begin(); it != p.vertices_end(); ++it) { cgal_point_t P(it->cartesian(0), it->cartesian(1), 0); P = t_.transform(P); w.push_back(P); } return w; } }; void transform_in_place(cgal_wire_t& w, const CGAL::Aff_transformation_3& t) { for (auto& p : w) { p = p.transform(t); } } } namespace { void face_to_poly_with_holes(const cgal_face_t& face, CGAL::Polygon_with_holes_2& pwh, CGAL::Aff_transformation_3& place) { // static Kernel_::Vector_3 Z(0, 0, 1); // static Kernel_::Vector_3 X(1, 0, 0); auto refz = newell(face.outer); refz /= std::sqrt(CGAL::to_double(refz.squared_length())); auto refx = CGAL::abs(refz.cartesian(0)) > CGAL::abs(refz.cartesian(2)) ? Z : X; auto refy = CGAL::cross_product(refz, refx); auto refl = face.outer.front(); place = CGAL::Aff_transformation_3( refx.cartesian(0), refy.cartesian(0), refz.cartesian(0), refl.cartesian(0), refx.cartesian(1), refy.cartesian(1), refz.cartesian(1), refl.cartesian(1), refx.cartesian(2), refy.cartesian(2), refz.cartesian(2), refl.cartesian(2) ); /* CGAL::NT_converter c; std::array, 4> matrix; for (int i = 0; i < 4; ++i) { for (int j = 0; j < 4; ++j) { matrix[i][j] = c(place.cartesian(i, j)); } } */ auto ref = place.inverse(); auto face_copy = face; transform_in_place(face_copy.outer, ref); for (auto& w : face_copy.inner) { transform_in_place(w, ref); } std::vector> holes; holes.reserve(face_copy.inner.size()); std::transform(face_copy.inner.begin(), face_copy.inner.end(), std::back_inserter(holes), wire_to_polygon_2); pwh = CGAL::Polygon_with_holes_2(wire_to_polygon_2(face_copy.outer), holes.begin(), holes.end()); } } bool CgalKernel::convert(const taxonomy::loop::ptr loop, cgal_wire_t& result) { // @todo only implement polygonal loops std::vector points; for (auto& e : loop->children) { std::vector edge; if (e->basis && e->basis->kind() != taxonomy::LINE) { convert_curve(settings_, e, edge); } else { edge = { *std::get(e->start), *std::get(e->end) }; } if (!e->orientation.value_or(true)) { std::reverse(edge.begin(), edge.end()); } extend_wire(points, edge); } if (points.size() >= 2) { // the edges -> conversion left us with a duplicate global begin,end point. double d = (points.back().ccomponents() - points.front().ccomponents()).norm(); if (d < 1.e-5) { points.erase(points.end() - 1); } else { logger::warning("Loop not closed", loop->instance); } } // Parse and store the points in a sequence cgal_wire_t polygon = std::vector(); for (auto& p : points) { cgal_point_t pnt(p.ccomponents()(0), p.ccomponents()(1), p.ccomponents()(2)); polygon.push_back(pnt); } // A loop should consist of at least three vertices std::size_t original_count = polygon.size(); if (original_count < 3) { logger::warning("Not enough edges for:", loop->instance); return false; } // Remove points that are too close to one another // this is done now in the mapping layer with Eigen // remove_duplicate_points_from_loop(polygon); std::size_t count = polygon.size(); if (original_count - count != 0) { std::stringstream ss; ss << (original_count - count) << " edges removed for:"; logger::warning(ss.str(), loop->instance); } { std::set visited_points; for (auto& p : polygon) { if (visited_points.find(p) != visited_points.end()) { logger::error("Skipping self-intersecting loop", loop->instance); // @todo signal somehow that occt kernel might be able to solve this // @todo implement cycle detection using Arrangement_2, but that only works in exact kernel return false; } visited_points.insert(p); } } std::vector segments; loop_to_segments(polygon, segments); auto inf = 1.e9; // std::numeric_limits::infinity(); double min_len = +inf; for (auto& s : segments) { auto l = std::sqrt(CGAL::to_double(s.squared_length())); if (l < min_len) { min_len = l; } } if (do_segments_intersect(segments)) { logger::message(logger::LOG_WARNING, "Skipping self-intersecting loop", loop->instance); return false; } auto dir = newell(polygon); Kernel_::FT min_dot(+inf), max_dot(-inf); for (auto& p : polygon) { auto dot = dir * (p - CGAL::ORIGIN); if (dot < min_dot) { min_dot = dot; } if (dot > max_dot) { max_dot = dot; } } auto delta_dot = max_dot - min_dot; // @todo this can be used to assess face planarity. /* std::wcerr << "[" << std::endl; for (auto& p : polygon) { std::wcerr << " (" << CGAL::to_double(p.cartesian(0)) << ", " << CGAL::to_double(p.cartesian(1)) << ", " << CGAL::to_double(p.cartesian(2)) << ")," << std::endl; } std::wcerr << "]" << std::endl; */ if (count < 3) { logger::message(logger::LOG_ERROR, "Not enough edges for:", loop->instance); return false; } result = polygon; // std::cout << "PolyLoop: " << std::endl; // for (auto &point: polygon) { // std::cout << "\tPoint(" << point << ")" << std::endl; // } return true; } bool CgalKernel::convert_impl(const taxonomy::shell::ptr shell, ConversionResults& results) { cgal_shape_t shape; if (!convert(shell, shape)) { return false; } if (shape.size_of_facets() == 0) { return false; } results.emplace_back(ConversionResult( shell->instance.id(), shell->matrix, new CgalShape(shape), shell->surface_style )); return true; } bool CgalKernel::convert_impl(const taxonomy::solid::ptr solid, ConversionResults& results) { if (solid->children.size() > 1) { logger::error("Multiple shells in solid not supported at the moment"); return false; } cgal_shape_t shape; if (solid->children.empty()) { return false; } // @todo if (!convert(solid->children[0], shape)) { return false; } if (shape.size_of_facets() == 0) { return false; } results.emplace_back(ConversionResult( solid->instance.id(), solid->matrix, new CgalShape(shape), solid->surface_style )); return true; } namespace { bool convert_placement(const Eigen::Matrix4d& m, cgal_placement_t& trsf) { // @todo check trsf = cgal_placement_t( m(0, 0), m(0, 1), m(0, 2), m(0, 3), m(1, 0), m(1, 1), m(1, 2), m(1, 3), m(2, 0), m(2, 1), m(2, 2), m(2, 3)); return true; } bool convert_placement(ifcopenshell::geometry::taxonomy::matrix4::ptr place, cgal_placement_t& trsf) { return convert_placement(place->ccomponents(), trsf); } } bool ifcopenshell::geometry::kernels::CgalKernel::convert_openings(const express::Base& entity, const std::vector>& openings, const IfcGeom::ConversionResults & entity_shapes, const ifcopenshell::geometry::taxonomy::matrix4 & entity_trsf, IfcGeom::ConversionResults & cut_shapes) { #ifdef IFOPSH_SIMPLE_KERNEL return false; #else CGAL::Nef_nary_union_3> second_operand_collector; size_t second_operand_collector_size = 0; std::list>> operands; std::list second_operand_instances; std::list first_operands, second_operands; std::list> first_operands_nef, second_operands_nef; for (auto& shp : entity_shapes) { cgal_shape_t entity_shape = *std::static_pointer_cast(shp.Shape()); const auto& m = shp.Placement()->ccomponents(); if (!m.isIdentity()) { cgal_placement_t trsf; convert_placement(m, trsf); for (auto &vertex : vertices(entity_shape)) { vertex->point() = vertex->point().transform(trsf); } } first_operands.push_back(entity_shape); CGAL::Nef_polyhedron_3 a; if (!preprocess_boolean_operand(entity, {}, {}, {}, entity_shape, a, PP_NONE /*PP_UNIFY_PLANES_INTERNALLY*/)) { return false; } first_operands_nef.push_back(a); } std::list all_operand_planes; for (auto& op : openings) { auto opening_trsf = op.second; Eigen::Matrix4d relative = entity_trsf.ccomponents().inverse() * opening_trsf.ccomponents(); opening_trsf = relative; ConversionResults opening_shapes; AbstractKernel::convert(op.first, opening_shapes); for (unsigned int i = 0; i < opening_shapes.size(); ++i) { cgal_shape_t entity_shape_unlocated = *std::static_pointer_cast(opening_shapes[i].Shape()); cgal_shape_t entity_shape(entity_shape_unlocated); auto gtrsf = opening_shapes[i].Placement(); // @todo check Eigen::Matrix4d m = opening_trsf.ccomponents() * gtrsf->ccomponents(); if (!m.isIdentity()) { cgal_placement_t trsf; convert_placement(m, trsf); for (auto &vertex : vertices(entity_shape)) { vertex->point() = vertex->point().transform(trsf); } } CGAL::Nef_polyhedron_3 nef; if (!preprocess_boolean_operand(op.first->instance, {}, {}, {}, entity_shape, nef, PP_NONE)) { continue; } // auto tree = build_halfspace_tree_decomposed(nef, all_operand_planes); second_operand_instances.push_back(op.first->instance); second_operands.push_back(entity_shape); second_operands_nef.push_back(nef); } } auto iit = second_operand_instances.begin(); auto pit = second_operands.begin(); for (auto& nef : second_operands_nef) { auto& inst = *iit++; auto& entity_shape = *pit++; if (!preprocess_boolean_operand(inst, first_operands, first_operands_nef, all_operand_planes, entity_shape, nef, PP_MINKOWSKY_DILATE/*PP_SNAP_PLANES_TO_FIRST_OPERAND*/)) { continue; } second_operand_collector.add_polyhedron(nef); second_operand_collector_size++; } if (!second_operand_collector_size) { return false; } auto opening_union = second_operand_collector.get_union(); auto it = entity_shapes.begin(); auto nit = first_operands_nef.begin(); for (auto& entity_shape : first_operands) { auto& a = *nit; if constexpr (false) { static int NN = 0; auto s = std::string("debug-first-operand-") + std::to_string(NN++) + ".off"; std::ofstream ofs(s.c_str()); ofs << entity_shape; } a -= opening_union; cgal_shape_t a_poly; try { a.convert_to_polyhedron(a_poly); } catch (...) { logger::message(logger::LOG_ERROR, "Could not convert from Nef:", entity); return false; } cut_shapes.push_back(IfcGeom::ConversionResult(it->ItemId(), new CgalShape(a_poly), it->StylePtr())); it++; nit++; } return true; #endif } bool CgalKernel::convert_impl(const taxonomy::extrusion::ptr extrusion, ConversionResults& results) { cgal_shape_t shape; if (!convert(extrusion, shape)) { return false; } results.emplace_back(ConversionResult( extrusion->instance.id(), extrusion->matrix, new CgalShape(shape), extrusion->surface_style )); return true; } bool CgalKernel::process_extrusion(const cgal_face_t& bottom_face, taxonomy::direction3::ptr direction, double height, cgal_shape_t& shape) { bool has_inner_bounds = !bottom_face.inner.empty(); std::list faces_to_extrude; std::set> internal_edges; // CGAL::Cartesian_converter> C; if (has_inner_bounds) { CGAL::Polygon_with_holes_2 pwh; CGAL::Aff_transformation_3 place; // @todo check for segment intersections, analogous to other places. // they are caught now below after triangulation. face_to_poly_with_holes(bottom_face, pwh, place); CGAL::Polygon_triangulation_decomposition_2 decompositor; std::list> decom_polies; decompositor(pwh, std::back_inserter(decom_polies)); int n_vertices = 0; std::map point_map; for (auto& p : decom_polies) { for (auto it = p.vertices_begin(); it != p.vertices_end(); ++it) { point_map.insert({ *it, point_map.size() }); ++n_vertices; } } std::map, std::pair> external_edges; size_t i = 0; for (auto& p : decom_polies) { // this is always 3 given the usage of Polygon_triangulation_decomposition_2 size_t n = std::distance(p.vertices_begin(), p.vertices_end()); for (size_t j = 0; j < n; ++j) { auto k = (j + 1) % n; auto& p0 = *(p.vertices_begin() + j); auto& p1 = *(p.vertices_begin() + k); auto i0 = point_map.find(p0)->second; auto i1 = point_map.find(p1)->second; if (i0 > i1) { std::swap(i0, i1); } auto p = external_edges.insert({ { i0, i1 }, { i, j} }); if (!p.second) { // Mark as internal before erasure in external // This is {i,j} at the time the edge use was inserted. internal_edges.insert(p.first->second); // not inserted, remove external_edges.erase(p.first); // @nb note the difference here in indices, {i0, i1} is point indices in // point_map. i is index in faces_to_extrude, j is segment index in wire. internal_edges.insert({ i, j }); } } i++; } polygon_2_to_wire wire_builder(place); std::transform(decom_polies.begin(), decom_polies.end(), std::back_inserter(faces_to_extrude), wire_builder); } else { faces_to_extrude.push_front(bottom_face.outer); } std::list face_list; auto& fs = direction->ccomponents(); cgal_direction_t dir(fs(0), fs(1), fs(2)); int wi = 0; for (auto& w : faces_to_extrude) { auto fnorm = newell(w); const bool reverse = fnorm * dir > 0; if (reverse) { cgal_face_t bottom_face; for (auto vertex = w.rbegin(); vertex != w.rend(); ++vertex) { bottom_face.outer.push_back(*vertex); } face_list.push_back(bottom_face); } else { face_list.push_back(cgal_face_t{ w }); } int si = 0; for (std::vector::const_iterator current_vertex = w.begin(); current_vertex != w.end(); ++current_vertex, ++si) { if (internal_edges.find({ wi, si }) != internal_edges.end()) { continue; } auto next_vertex = current_vertex + 1; if (next_vertex == w.end()) { next_vertex = w.begin(); } cgal_face_t side_face; if (reverse) { side_face.outer.push_back(*current_vertex + height * dir); side_face.outer.push_back(*next_vertex + height * dir); side_face.outer.push_back(*next_vertex); side_face.outer.push_back(*current_vertex); } else { side_face.outer.push_back(*current_vertex); side_face.outer.push_back(*next_vertex); side_face.outer.push_back(*next_vertex + height * dir); side_face.outer.push_back(*current_vertex + height * dir); } face_list.push_back(side_face); } cgal_face_t top_face; if (reverse) { for (auto vertex = w.begin(); vertex != w.end(); ++vertex) { top_face.outer.push_back(*vertex + height * dir); } } else { for (auto vertex = w.rbegin(); vertex != w.rend(); ++vertex) { top_face.outer.push_back(*vertex + height * dir); } } face_list.push_back(top_face); wi++; } shape = utils::create_polyhedron(face_list); // if (has_position) for (auto &vertex : vertices(shape)) vertex->point() = vertex->point().transform(trsf); return true; /* CGAL::Nef_polyhedron_3 nef_shape = utils::create_nef_polyhedron(face_list); // Inner // TODO: Would be faster to triangulate top/bottom face template rather than use Nef polyhedra for subtraction for (auto &inner : bottom_face.inner) { // std::cout << "Inner wire" << std::endl; face_list.clear(); cgal_face_t hole_bottom_face; hole_bottom_face.outer = inner; remove_duplicate_points_from_loop(hole_bottom_face.outer); face_list.push_back(hole_bottom_face); for (std::vector::const_iterator current_vertex = inner.begin(); current_vertex != inner.end(); ++current_vertex) { std::vector::const_iterator next_vertex = current_vertex; ++next_vertex; if (next_vertex == inner.end()) { next_vertex = inner.begin(); } cgal_face_t hole_side_face; hole_side_face.outer.push_back(*next_vertex); hole_side_face.outer.push_back(*current_vertex); hole_side_face.outer.push_back(*current_vertex + height * dir); hole_side_face.outer.push_back(*next_vertex + height * dir); face_list.push_back(hole_side_face); } cgal_face_t hole_top_face; for (std::vector::const_reverse_iterator vertex = inner.rbegin(); vertex != inner.rend(); ++vertex) { hole_top_face.outer.push_back(*vertex + height * dir); } face_list.push_back(hole_top_face); try { nef_shape -= utils::create_nef_polyhedron(face_list); } catch (...) { logger::message(logger::LOG_ERROR, "IfcExtrudedAreaSolid: cannot subtract opening for:"); return false; } } */ /*if (has_position) { // IfcSweptAreaSolid.Position (trsf) is an IfcAxis2Placement3D // and therefore has a unit scale factor nef_shape.transform(trsf); }*/ /* try { nef_shape.convert_to_polyhedron(shape); return true; } catch (...) { logger::message(logger::LOG_ERROR, "IfcExtrudedAreaSolid: cannot convert Nef to polyhedron for:"); return false; } */ } bool CgalKernel::convert(const taxonomy::extrusion::ptr extrusion, cgal_shape_t &shape) { const double& height = extrusion->depth; if (height < settings_.get().get()) { logger::message(logger::LOG_ERROR, "Non-positive extrusion height encountered for:", extrusion->instance); return false; } std::list bottom_face; if (!convert(taxonomy::cast(taxonomy::cast(extrusion->basis)), bottom_face) || bottom_face.size() != 1) { return false; } return process_extrusion(bottom_face.front(), extrusion->direction, extrusion->depth, shape); } CGAL::Polyhedron_3 ifcopenshell::geometry::utils::create_cube(double d) { cgal_face_t bottom_face; bottom_face.outer.push_back(Kernel_::Point_3(-d, -d, -d)); bottom_face.outer.push_back(Kernel_::Point_3(+d, -d, -d)); bottom_face.outer.push_back(Kernel_::Point_3(+d, +d, -d)); bottom_face.outer.push_back(Kernel_::Point_3(-d, +d, -d)); cgal_direction_t dir(0, 0, 2 * d); std::list face_list = { bottom_face }; for (std::vector::const_iterator current_vertex = bottom_face.outer.begin(); current_vertex != bottom_face.outer.end(); ++current_vertex) { std::vector::const_iterator next_vertex = current_vertex; ++next_vertex; if (next_vertex == bottom_face.outer.end()) { next_vertex = bottom_face.outer.begin(); } cgal_face_t side_face; side_face.outer.push_back(*next_vertex); side_face.outer.push_back(*current_vertex); side_face.outer.push_back(*current_vertex + dir); side_face.outer.push_back(*next_vertex + dir); face_list.push_back(side_face); } cgal_face_t top_face; for (std::vector::const_reverse_iterator vertex = bottom_face.outer.rbegin(); vertex != bottom_face.outer.rend(); ++vertex) { top_face.outer.push_back(*vertex + dir); } face_list.push_back(top_face); return create_polyhedron(face_list); } CGAL::Polyhedron_3 ifcopenshell::geometry::utils::create_cube(const Kernel_::Point_3& lower, const Kernel_::Point_3& upper) { cgal_face_t bottom_face; auto a0 = lower.cartesian(0); auto a1 = lower.cartesian(1); auto a2 = lower.cartesian(2); auto b0 = upper.cartesian(0); auto b1 = upper.cartesian(1); auto b2 = upper.cartesian(2); bottom_face.outer.push_back(Kernel_::Point_3(a0, a1, a2)); bottom_face.outer.push_back(Kernel_::Point_3(b0, a1, a2)); bottom_face.outer.push_back(Kernel_::Point_3(b0, b1, a2)); bottom_face.outer.push_back(Kernel_::Point_3(a0, b1, a2)); cgal_direction_t dir(0, 0, b2 - a2); std::list face_list = { bottom_face }; for (std::vector::const_iterator current_vertex = bottom_face.outer.begin(); current_vertex != bottom_face.outer.end(); ++current_vertex) { std::vector::const_iterator next_vertex = current_vertex; ++next_vertex; if (next_vertex == bottom_face.outer.end()) { next_vertex = bottom_face.outer.begin(); } cgal_face_t side_face; side_face.outer.push_back(*next_vertex); side_face.outer.push_back(*current_vertex); side_face.outer.push_back(*current_vertex + dir); side_face.outer.push_back(*next_vertex + dir); face_list.push_back(side_face); } cgal_face_t top_face; for (std::vector::const_reverse_iterator vertex = bottom_face.outer.rbegin(); vertex != bottom_face.outer.rend(); ++vertex) { top_face.outer.push_back(*vertex + dir); } face_list.push_back(top_face); return create_polyhedron(face_list); } #ifndef IFOPSH_SIMPLE_KERNEL bool CgalKernel::thin_solid(const CGAL::Nef_polyhedron_3& a, CGAL::Nef_polyhedron_3& result) { // @todo this should be possible as a minkowski sum of facet & cube. rather than a set of boolean ops. auto precision_cube_ = precision_cube(); auto a_nonconst = a; auto ax = CGAL::minkowski_sum_3(a_nonconst, precision_cube_); auto x = ax - a; result = x; return true; auto yxy = CGAL::minkowski_sum_3(x, precision_cube_); auto y = yxy * a; auto zyz = CGAL::minkowski_sum_3(y, precision_cube_); result = yxy * zyz; return true; } bool CgalKernel::preprocess_boolean_operand(const express::Base& log_reference, const std::list& first_operands, const std::list>& first_operands_nef, const std::list& all_operand_planes, const cgal_shape_t& shape_const, CGAL::Nef_polyhedron_3& result, boolean_operand_preprocess proc) { cgal_shape_t shape = shape_const; if (!shape.is_valid()) { logger::message(logger::LOG_ERROR, "Conversion to Nef will fail. Invalid geometry:", log_reference); return false; } if (!shape.is_closed()) { // TODO: There can be substractions to remove parts of non-volumetric objects. Maybe iterate over all faces of an entity and put them in a Nef_polyhedron_3 through Boolean union? Highly inefficient but maybe desirable... logger::message(logger::LOG_ERROR, "Subtraction of openings not supported for non-closed geometry:", log_reference); return false; } bool success = false; try { success = CGAL::Polygon_mesh_processing::triangulate_faces(shape); } catch (CGAL::Failure_exception& e) { logger::notice(e); logger::message(logger::LOG_ERROR, "Triangulation of geometry crashed:", log_reference); return false; } if (!success) { logger::message(logger::LOG_ERROR, "Triangulation of geometry failed:", log_reference); return false; } if (CGAL::Polygon_mesh_processing::does_self_intersect(shape)) { logger::message(logger::LOG_ERROR, "Conversion to Nef will fail. Self-intersecting geometry:", log_reference); return false; } if (proc == PP_SNAP_POINTS_TO_FIRST_OPERAND) { static int NN = 0; typedef CGAL::AABB_face_graph_triangle_primitive AABB_face_graph_primitive; #if CGAL_VERSION_NR >= 1060000000 typedef CGAL::AABB_traits_3 AABB_face_graph_traits; #else typedef CGAL::AABB_traits AABB_face_graph_traits; #endif CGAL::AABB_tree tree; for (auto& op : first_operands) { auto tm = op; CGAL::Polygon_mesh_processing::triangulate_faces(tm); CGAL::Polygon_mesh_processing::build_AABB_tree(tm, tree); std::transform(tm.facets_begin(), tm.facets_end(), tm.planes_begin(), [](auto& f) { auto h = f.halfedge(); return CGAL::Plane_3(h->vertex()->point(), h->next()->vertex()->point(), h->next()->next()->vertex()->point()); }); for (auto it = shape.vertices_begin(); it != shape.vertices_end(); ++it) { for (auto& x : first_operands) { // @nb snapping_tolerance 'snaps' the barycentric coords to 0 or 1 // so that not only the point aligns to the face, but to an edge // as well. Snapping only to face would cause a rotation of line b: // + // | // | // | // | // | // o--> // | | // | | // | | // b| | // | | // | | // | | // o | // +---v--+ auto ploc = CGAL::Polygon_mesh_processing::locate_with_AABB_tree(it->point(), tree, tm, CGAL::Polygon_mesh_processing::parameters::snapping_tolerance(1.e-5)); /*std::stringstream ss; ss << std::setprecision(16) << ploc.second[0] << " " << ploc.second[1] << " " << ploc.second[2] << std::endl; auto sss = ss.str(); std::wcout << sss.c_str() << std::endl;*/ auto v = ploc.first->plane().orthogonal_vector(); auto new_point = CGAL::Polygon_mesh_processing::construct_point(ploc, tm); if ((v * (new_point - it->point())) > 0) { auto vl = std::sqrt(CGAL::to_double(v.squared_length())); // @nb offsetting along plane normal is still necessary even after snapping it->point() = new_point + (v / vl) * 1.e-5; } } } } auto s = std::string("debug-operand-") + std::to_string(NN++) + ".off"; std::ofstream ofs(s.c_str()); ofs << shape; } try { result = CGAL::Nef_polyhedron_3(shape); } catch (CGAL::Failure_exception& e) { logger::notice(e); logger::message(logger::LOG_ERROR, "Could not convert geometry to Nef:", log_reference); return false; } if (proc == PP_SNAP_PLANES_TO_FIRST_OPERAND) { std::list planes_fixed; std::list temp; for (auto& nef : first_operands_nef) { // @todo eliminate this copy (= to remove const) auto nef_copy = nef; auto tree = build_halfspace_tree_decomposed(nef_copy, planes_fixed); } { // @nb we snap internally as well... // @todo we can probably eliminate an evaluate() here { // @todo is it deterministic enough so that rebuilding the same tree is identical/compatible? auto tree = build_halfspace_tree_decomposed(result, temp); auto pmap = snap_halfspaces(all_operand_planes, 1.e-5); result = tree->map(pmap)->evaluate(); } { std::list planes; auto tree = build_halfspace_tree_decomposed(result, planes); auto pmap = snap_halfspaces_2(planes_fixed, planes, 1.e-5); result = tree->map(pmap)->evaluate(); } } } else if (proc == PP_UNIFY_PLANES_INTERNALLY) { std::list planes; auto tree = build_halfspace_tree_decomposed(result, planes); auto pmap = snap_halfspaces(planes, 1.e-6); std::wcout << tree->dump().c_str() << std::endl; auto mapped = tree->map(pmap); std::wcout << mapped->dump().c_str() << std::endl; { static int i = 1; auto x = (halfspace_tree_nary_branch*)&*tree; int j = 0; for (auto& a : x->operands_) { auto A = a->evaluate(); cgal_shape_t p; A.convert_to_Polyhedron(p); std::string fn = "debug-orig-" + std::to_string(i) + "-" + std::to_string(j++) + ".off"; std::ofstream(fn.c_str()) << p; } i++; } { static int i = 1; auto x = (halfspace_tree_nary_branch*)&*mapped; int j = 0; for (auto& a : x->operands_) { auto A = a->evaluate(); cgal_shape_t p; A.convert_to_Polyhedron(p); std::string fn = "debug-mapped-" + std::to_string(i) + "-" + std::to_string(j++) + ".off"; std::ofstream(fn.c_str()) << p; } i++; } result = mapped->evaluate(); } if (proc == PP_MINKOWSKY_DILATE) { auto precision_cube_ = precision_cube(); try { // @todo don't dilate in 3 dimensions but only in the XY plane, orthogonal to wall axis. result = CGAL::minkowski_sum_3(result, precision_cube_); } catch (CGAL::Failure_exception& e) { logger::notice(e); logger::message(logger::LOG_ERROR, "Could not dilate boolean operand", log_reference); return false; } } /* { size_t vi = 0; static int i = 1; std::string fn = "debug-" + std::to_string(i) + "-" + std::to_string(vi) + ".off"; auto ofs = std::make_unique(fn.c_str()); while (write_to_obj(result, *ofs, vi++)) { fn = "debug-" + std::to_string(i++) + "-" + std::to_string(vi) + ".off"; ofs = std::make_unique(fn.c_str()); } i += 1; } */ try { cgal_shape_t convert_back; result.convert_to_polyhedron(convert_back); } catch (CGAL::Failure_exception& e) { logger::notice(e); logger::message(logger::LOG_WARNING, "Final conversion will likely fail. Could not convert geometry from Nef:", log_reference); } return true; } #include #endif bool CgalKernel::process_as_2d_polygon(const taxonomy::boolean_result::ptr br, std::list>& loops, double& z0, double& z1) { // @todo can also be for other boolean operations, just depth/matrix operands are different if (br->operation != taxonomy::boolean_result::SUBTRACTION) { return false; } typedef std::pair extrusion_pair; // @todo delete extrusion_pair.first auto& ops = br->children; std::vector extrusions; std::transform(ops.begin(), ops.end(), std::back_inserter(extrusions), [](taxonomy::ptr op) { static std::pair nptr = { nullptr, nullptr }; Eigen::Matrix4d* m4 = nullptr; if (auto ex = taxonomy::dcast(op)) { return std::make_pair(m4, ex); } auto cl = taxonomy::dcast(op); if (!cl) return nptr; if ((cl)->children.size() != 1) return nptr; m4 = new Eigen::Matrix4d(cl->matrix->ccomponents()); if (cl->children[0]->kind() == taxonomy::COLLECTION) { cl = taxonomy::cast(cl->children[0]); if ((cl)->children.size() != 1) { delete m4; return nptr; } (*m4) = (*m4) * cl->matrix->ccomponents(); } if (cl->children[0]->kind() != taxonomy::EXTRUSION) { delete m4; return nptr; } auto ex = taxonomy::cast(cl->children[0]); return std::make_pair(m4, ex); }); if (std::find_if(extrusions.begin(), extrusions.end(), [](extrusion_pair& p) { return p.second == nullptr; }) != extrusions.end()) { return false; } // op[i].matrix[2,0:3] = <0 0 1> Eigen::Vector3d Z(0., 0., 1.); if (std::find_if(extrusions.begin(), extrusions.end(), [&Z](extrusion_pair& p) { // @todo factor in p.first; auto ex = p.second; auto& m = ex->matrix->ccomponents(); return std::abs(1. - std::abs(m.col(2).head<3>().dot(Z))) > 1.e-5; }) != extrusions.end()) { return false; } // | op[i].matrix[2,0:3] . op[i].direction | = 1 if (std::find_if(extrusions.begin(), extrusions.end(), [](extrusion_pair& p) { auto ex = p.second; auto& d = ex->direction->ccomponents(); auto& m = ex->matrix->ccomponents(); return std::abs(1. - std::abs(m.col(2).head<3>().dot(d))) > 1.e-5; }) != extrusions.end()) { return false; } // op[0].depth <= op[i..n].depth const auto& op_0_depth = extrusions[0].second->depth; if (std::find_if(extrusions.begin() + 1, extrusions.end(), [&op_0_depth](extrusion_pair& p) { auto ex = p.second; return op_0_depth > ex->depth; }) != extrusions.end()) { return false; } const auto& op_0_matrix_2_3 = extrusions[0].second->matrix->ccomponents()(2, 3); if (std::find_if(extrusions.begin() + 1, extrusions.end(), [&op_0_matrix_2_3](extrusion_pair& p) { auto ex = p.second; return op_0_matrix_2_3 < ex->matrix->components()(2, 3); }) != extrusions.end()) { return false; } std::vector wires; try { std::transform(extrusions.begin(), extrusions.end(), std::back_inserter(wires), [this](extrusion_pair& p) { auto ex = p.second; auto ex_basis = taxonomy::cast(ex->basis); if (ex_basis->children.size() == 1 && ex_basis->children[0]->kind() == taxonomy::LOOP) { auto l = (taxonomy::loop::ptr) ex_basis->children[0]; cgal_wire_t w; cgal_placement_t trsf; convert_placement(ex->matrix, trsf); cgal_placement_t trsf2; if (p.first) { convert_placement(*p.first, trsf2); } /* std::array, 4> mat; for (int i = 0; i < 4; ++i) { for (int j = 0; j < 4; ++j) { mat[i][j] = CGAL::to_double(trsf.cartesian(i, j)); } } */ if (convert(l, w)) { for (auto& pt : w) { // @todo figure out order. pt = pt.transform(trsf); if (p.first) { pt = pt.transform(trsf2); } } return w; } } throw std::runtime_error("failed to convert to polygon"); }); } catch (std::runtime_error&) { return false; } loops.clear(); std::transform(wires.begin(), wires.end(), std::back_inserter(loops), wire_to_polygon_2); auto& op_0_matrix = extrusions[0].second->matrix->ccomponents(); Eigen::Vector4d op_0_dir; op_0_dir << extrusions[0].second->direction->ccomponents(), 0; op_0_dir = op_0_matrix * op_0_dir; z0 = op_0_matrix_2_3; z1 = z0 + extrusions[0].second->depth * op_0_dir(2); if (z1 < z0) { std::swap(z0, z1); } return true; } #include namespace { bool orthogonal_edge_length(const cgal_shape_t& shape, const cgal_direction_t& face_normal, std::pair& distances) { static double inf = 1.e9; // std::numeric_limits::infinity(); std::vector lengths; distances = { +inf, -inf }; for (const auto& e : edges(shape)) { const auto& p0 = e.halfedge()->vertex()->point(); const auto& p1 = e.halfedge()->next()->vertex()->point(); auto p01 = p1 - p0; auto p01_length = std::sqrt(CGAL::to_double(p01.squared_length())); p01 /= p01_length; auto dot = std::abs(CGAL::to_double(p01 * face_normal)); if (dot > 1e-5) { if (dot < 0.9999) { return false; } else { lengths.push_back(p01_length); auto v = (p0 - CGAL::ORIGIN) * face_normal; if (v < distances.first) { distances.first = v; } if (v > distances.second) { distances.second = v; } v = (p1 - CGAL::ORIGIN) * face_normal; if (v < distances.first) { distances.first = v; } if (v > distances.second) { distances.second = v; } } } } std::sort(lengths.begin(), lengths.end()); auto edge_len_diff = lengths.back() - lengths.front(); std::wcout << "edge_len_diff " << edge_len_diff << std::endl; if (edge_len_diff > 1e-5) { return false; } return true; } } bool CgalKernel::process_as_2d_polygon(const std::list>>& operands, std::list>& loops, double& z0, double& z1) { if (operands.front().size() != 1) { return false; } auto& first_op = operands.front().front().second; cgal_shape_t::Facet_handle largest_face; Kernel_::FT largest_area = 0; for (auto& f : faces(first_op)) { auto area = CGAL::Polygon_mesh_processing::face_area(f, first_op); if (area > largest_area) { largest_area = area; largest_face = f; } } // @todo adapt newell() to work on facet circulator as well std::vector f_points; CGAL::Polyhedron_3::Halfedge_around_facet_const_circulator current_halfedge = largest_face->facet_begin(); do { f_points.push_back(current_halfedge->vertex()->point()); ++current_halfedge; } while (current_halfedge != largest_face->facet_begin()); auto fnorm = newell(f_points); fnorm /= std::sqrt(CGAL::to_double(fnorm.squared_length())); std::pair operand_1_distance_along_normal; if (!orthogonal_edge_length(first_op, fnorm, operand_1_distance_along_normal)) { return false; } for (auto it = ++operands.begin(); it != operands.end(); ++it) { for (auto jt = it->begin(); jt != it->end(); ++jt) { auto& nth_op = jt->second; std::pair operand_n_distance_along_normal; if (!orthogonal_edge_length(nth_op, fnorm, operand_n_distance_along_normal)) { return false; } std::wcout << CGAL::to_double(operand_n_distance_along_normal.first) << std::endl; std::wcout << CGAL::to_double(operand_n_distance_along_normal.second) << std::endl; std::wcout << CGAL::to_double(operand_1_distance_along_normal.first) << std::endl; std::wcout << CGAL::to_double(operand_1_distance_along_normal.second) << std::endl; if (operand_n_distance_along_normal.first > operand_1_distance_along_normal.first || operand_n_distance_along_normal.second < operand_1_distance_along_normal.second) { return false; } } } std::wcout << "Process as 2D!!!" << std::endl; return true; } namespace { template void project_onto_plane(const taxonomy::plane& p, It i, It j, Fn fn) { auto mi = p.matrix->ccomponents().inverse(); Eigen::Vector4d v; std::for_each(i, j, [&mi, &v, &fn](const cgal_shape_t& shp) { for (auto& vv : vertices(shp)) { auto& p = vv->point(); v = Eigen::Vector4d(CGAL::to_double(p.cartesian(0)), CGAL::to_double(p.cartesian(1)), CGAL::to_double(p.cartesian(2)), 1.); v = mi * v; fn(v.head<3>()); } }); } } bool CgalKernel::convert_impl(const taxonomy::boolean_result::ptr br, ConversionResults& results) { double z0, z1; std::list> loops; if (process_as_2d_polygon(br, loops, z0, z1)) { taxonomy::style::ptr first_item_style = nullptr; { auto gi = br->children[0]; while (gi) { if (gi->surface_style) { first_item_style = gi->surface_style; break; } auto ci = taxonomy::dcast(gi); if (ci && ci->children.size() == 1) { gi = ci->children[0]; } else { break; } } } std::list> pwhs; auto it = loops.begin(); const auto& p = *it; CGAL::Polygon_with_holes_2 pwh(p, ++it, loops.end()); CGAL::Gps_segment_traits_2 traits; if (!CGAL::are_holes_and_boundary_pairwise_disjoint(pwh, traits)) { #ifdef IFOPSH_SIMPLE_KERNEL throw std::runtime_error("Holes are not disjoint - use a different geometry kernel"); #else // this is very slow. // the check is also slow... // It is enabled because in case of overlapping openings the // even-odd fill rule will result in incorrect results. // See for example the Duplex model roof. logger::notice("Holes are not disjoint"); CGAL::Polygon_set_2 result; auto it = loops.begin(); result.insert(*it++); for (; it != loops.end(); ++it) { result.difference(*it); } result.polygons_with_holes(std::back_inserter(pwhs)); #endif } else { pwhs.push_back(pwh); } #if 0 CGAL::Polygon_vertical_decomposition_2 decompositor; #else CGAL::Polygon_triangulation_decomposition_2 decompositor; #endif std::list> decom_polies; for (auto& pwh : pwhs) { decompositor(pwh, std::back_inserter(decom_polies)); } std::transform(decom_polies.begin(), decom_polies.end(), std::back_inserter(results), [this, &br, &z0, &z1, &first_item_style](const CGAL::Polygon_2& p2) { cgal_face_t f; std::transform( p2.vertices_begin(), p2.vertices_end(), std::back_inserter(f.outer), [](const CGAL::Point_2& p) { return CGAL::Point_3(p.cartesian(0), p.cartesian(1), 0); } ); cgal_shape_t shp; auto d = taxonomy::make(0, 0, 1); process_extrusion(f, d, z1 - z0, shp); for (auto it = shp.vertices_begin(); it != shp.vertices_end(); ++it) { auto p = it->point(); it->point() = cgal_point_t(p.cartesian(0), p.cartesian(1), p.cartesian(2) + z0); } return ConversionResult( br->instance.id(), br->matrix, new CgalShape(shp), br->surface_style ? br->surface_style : first_item_style ); }); logger::notice("Processed boolean operation as 2d arrangement"); return true; } #ifdef IFOPSH_SIMPLE_KERNEL return false; #else bool first = true; CGAL::Nef_polyhedron_3 a; CGAL::Nef_nary_union_3> second_operand_collector; size_t second_operand_collector_size = 0; taxonomy::style::ptr first_item_style = nullptr; std::list>> operands; for (auto& c : br->children) { // AbstractKernel::convert(c, results); // continue; ConversionResults cr; operands.emplace_back(); operands.back().first = c->instance; if (c->kind() == taxonomy::SOLID && c->instance.declaration().is("IfcHalfSpaceSolid") && !first) { auto face = taxonomy::cast(c)->children[0]->children[0]; if (face->basis == nullptr || face->basis->kind() != taxonomy::PLANE) { return false; } static double inf = 1.e9; // std::numeric_limits::infinity(); static double eps = 1.e-5; double uvw_min[3] = { +inf, +inf, +inf }; double uvw_max[3] = { -inf, -inf, -inf }; auto& p = *taxonomy::cast(face->basis); project_onto_plane(p, operands.front().second.begin(), operands.front().second.end(), [&uvw_min, &uvw_max](const Eigen::Vector3d& p) { for (int i = 0; i < 3; ++i) { if (p(i) < uvw_min[i]) { uvw_min[i] = p(i); } if (p(i) > uvw_max[i]) { uvw_max[i] = p(i); } } }); double wmin, wmax; if (face->orientation.value_or(false)) { wmin = 0.; wmax = uvw_max[2] + eps; } else { wmin = uvw_min[2] - eps; wmax = 0.; } Kernel_::Point_3 lower(uvw_min[0] - eps, uvw_min[1] - eps, wmin); Kernel_::Point_3 upper(uvw_max[0] + eps, uvw_max[1] + eps, wmax); cgal_shape_t box = utils::create_cube(lower, upper); cgal_placement_t pl; convert_placement(p.matrix, pl); for (auto& v : vertices(box)) { v->point() = v->point().transform(pl); } if (!face->children.empty()) { std::list fs; if (!convert(face, fs) || fs.size() != 1) { return false; } auto& w = fs.front().outer; CGAL::Polygon_2 ps; for (auto& p : w) { ps.push_back({ p.x(), p.y() }); } if (!ps.is_simple()) { logger::warning("Polygonal boundary not simple", face->children[0]->instance); continue; } // static auto z = taxonomy::make(0, 0, 1); cgal_shape_t poly; process_extrusion(fs.front(), z, 200, poly); for (auto& v : vertices(poly)) { v->point() = Kernel_::Point_3( v->point().cartesian(0), v->point().cartesian(1), v->point().cartesian(2) - 100 ); }; cgal_placement_t trsf; convert_placement(face->matrix, trsf); for (auto& v : vertices(poly)) { v->point() = v->point().transform(trsf); } CGAL::Nef_polyhedron_3 poly_nef(poly); CGAL::Nef_polyhedron_3 box_nef(box); auto intersection = poly_nef * box_nef; cgal_shape_t intersection_poly; intersection.convert_to_polyhedron(intersection_poly); operands.back().second.push_back(intersection_poly); } else { operands.back().second.push_back(box); } continue; } AbstractKernel::convert(c, cr); if (first && br->operation == taxonomy::boolean_result::SUBTRACTION) { first_item_style = c->surface_style; if (!first_item_style && c->kind() == taxonomy::COLLECTION) { // @todo recursively right? first_item_style = taxonomy::cast(c)->children[0]->surface_style; } } for (auto it = cr.begin(); it != cr.end(); ++it) { cgal_shape_t entity_shape_unlocated = *std::static_pointer_cast(it->Shape()); cgal_shape_t entity_shape(entity_shape_unlocated); if (!it->Placement()->is_identity()) { cgal_placement_t trsf; convert_placement(it->Placement(), trsf); for (auto &vertex : vertices(entity_shape)) { vertex->point() = vertex->point().transform(trsf); } } operands.back().second.push_back(entity_shape); } first = false; } /* for (auto& li : operands) { for (auto& s : li.second) { results.emplace_back(ConversionResult( br->instance.data().id(), br->matrix, new CgalShape(s), br->surface_style ? br->surface_style : first_item_style )); } } return true; */ /* // Another check in case operands are not extrusion is not fully implemented yet. if (process_as_2d_polygon(operands, loops, z0, z1)) { return true; } */ /* // debugging trick for (auto& p : operands) { for (auto& s : p.second) { results.emplace_back(ConversionResult( br->instance.data().id(), br->matrix, new CgalShape(s), br->surface_style ? br->surface_style : first_item_style )); } } return true; */ first = true; std::list ops; std::list> nefops; std::list all_operand_planes; for (auto& li : operands) { auto entity_instance = li.first; for (auto& entity_shape : li.second) { CGAL::Nef_polyhedron_3 nef; if (!preprocess_boolean_operand(entity_instance, ops, nefops, all_operand_planes, entity_shape, nef, // Snap boolean subtraction operands first ? PP_NONE : PP_MINKOWSKY_DILATE/*PP_SNAP_PLANES_TO_FIRST_OPERAND*/)) { continue; } ops.push_front(entity_shape); nefops.push_back(nef); if (first) { a = nef; } else { if (br->operation == taxonomy::boolean_result::SUBTRACTION) { second_operand_collector.add_polyhedron(nef); second_operand_collector_size++; // a -= nef; } else if (br->operation == taxonomy::boolean_result::INTERSECTION) { a *= nef; } else if (br->operation == taxonomy::boolean_result::UNION) { a += nef; } } } first = false; } if (br->operation == taxonomy::boolean_result::SUBTRACTION && second_operand_collector_size) { a -= second_operand_collector.get_union(); } cgal_shape_t a_poly; // CGAL::Nef_polyhedron_3 b; // thin_solid(a, b); try { a.convert_to_polyhedron(a_poly); } catch (...) { logger::message(logger::LOG_ERROR, "Could not convert geometry with openings from Nef:", br->instance); return false; } results.emplace_back(ConversionResult( br->instance.id(), br->matrix, new CgalShape(a_poly), br->surface_style ? br->surface_style : first_item_style )); return true; #endif } PolyhedronBuilder::PolyhedronBuilder(std::list* face_list) { this->face_list = face_list; } #include // @todo shouldn't we just always use polygon_soup_to_polygon_mesh instead of the incremental builder? #include void PolyhedronBuilder::operator()(CGAL::Polyhedron_3::HalfedgeDS &hds) { // std::list points; std::map points; std::vector> facet_vertices; facet_vertices.reserve(face_list->size()); CGAL::Polyhedron_incremental_builder_3::HalfedgeDS> builder(hds, true); std::list unique_points; for (auto &face : *face_list) { if (face.inner.empty()) { facet_vertices.emplace_back(); for (auto &point : face.outer) { auto p = points.insert({ point, points.size() }); if (p.second) { unique_points.push_back(point); } facet_vertices.back().push_back(p.first->second); } } else { std::map points_2d; CGAL::Polygon_with_holes_2 pwh; CGAL::Aff_transformation_3 place; face_to_poly_with_holes(face, pwh, place); // we assume the pwh constructor leaves points in order // wouldn't it be nice to have the equivalent of Python's zip() { auto it = pwh.outer_boundary().vertices_begin(); auto jt = face.outer.begin(); for (; it != pwh.outer_boundary().vertices_end(); ++it, ++jt) { auto p = points.insert({ *jt, points.size() }); if (p.second) { unique_points.push_back(*jt); } points_2d.insert({ *it, p.first->second }); } } auto it = pwh.holes_begin(); auto kt = face.inner.begin(); for (; it != pwh.holes_end(); ++it, ++kt) { auto jt = it->vertices_begin(); auto lt = kt->begin(); for (; jt != it->vertices_end(); ++jt, ++lt) { auto p = points.insert({ *lt, points.size() }); if (p.second) { unique_points.push_back(*lt); } points_2d.insert({ *jt, p.first->second }); } } CGAL::Polygon_triangulation_decomposition_2 decompositor; std::list> decom_polies; decompositor(pwh, std::back_inserter(decom_polies)); for (auto& p : decom_polies) { facet_vertices.emplace_back(); for (auto it = p.vertices_begin(); it != p.vertices_end(); ++it) { auto pit = points_2d.find(*it); if (pit == points_2d.end()) { // Likely there are intersections in the polygonal boundaries. // For now let's just skip over the triangle. We can also use // the Aff_transformation_3 stored in place to convert the 2d // coords back to 3d. logger::warning("Ignoring triangulated facet with novel point likely due to self-intersections"); facet_vertices.erase(facet_vertices.end() - 1); break; } facet_vertices.back().push_back(pit->second); } } } } /* // We don't do this ourselves anymore, but defer this to is_polygon_soup_a_polygon_mesh() bool valid_orientation = true; std::set> added_edges; for (size_t fi = 0; fi < facet_vertices.size(); ++fi) { auto& f = facet_vertices[fi]; for (size_t i = 0; i < f.size(); ++i) { auto p = std::pair(f[i], f[(i + 1) % f.size()]); if (added_edges.find(p) != added_edges.end()) { valid_orientation = false; break; } added_edges.insert(p); } if (!valid_orientation) { break; } } */ // if (!valid_orientation) { from_soup.emplace(); // @todo ugh std::vector unique_points_as_vector(unique_points.begin(), unique_points.end()); if (!CGAL::Polygon_mesh_processing::is_polygon_soup_a_polygon_mesh(facet_vertices)) { // @todo seems to return false now, almost always? // logger::warning("Reoriented polygonal surface"); CGAL::Polygon_mesh_processing::orient_polygon_soup(unique_points_as_vector, facet_vertices); } CGAL::Polygon_mesh_processing::polygon_soup_to_polygon_mesh(unique_points_as_vector, facet_vertices, *from_soup); return; // } /* std::vector facet_indices_to_delete; std::set> added_edges; for (size_t fi = 0; fi < facet_vertices.size(); ++fi) { auto& f = facet_vertices[fi]; bool reoriented = false, valid = true; check_edge_existence: for (size_t i = 0; i < f.size(); ++i) { auto p = std::pair(f[i], f[(i + 1) % f.size()]); if (added_edges.find(p) != added_edges.end()) { if (reoriented) { facet_indices_to_delete.push_back(fi); logger::notice("Removed facet"); valid = false; break; } else { std::reverse(f.begin(), f.end()); logger::notice("Reversed facet"); reoriented = true; goto check_edge_existence; } } } if (valid) { for (size_t i = 0; i < f.size(); ++i) { auto p = std::pair(f[i], f[(i + 1) % f.size()]); added_edges.insert(p); } } } std::reverse(facet_indices_to_delete.begin(), facet_indices_to_delete.end()); for (auto& fi : facet_indices_to_delete) { facet_vertices.erase(facet_vertices.begin() + fi); } */ /* // We just always use polygon_soup_to_polygon_mesh() to now. // @todo figure out the downsides of this approach. builder.begin_surface(points.size(), facet_vertices.size()); // , 0, CGAL::Polyhedron_incremental_builder_3::HalfedgeDS>::ABSOLUTE_INDEXING); for (auto& point : unique_points) { builder.add_vertex(point); } for (auto &facet : facet_vertices) { builder.begin_facet(); // std::cout << "Adding facet "; for (auto &vertex : facet) { // std::cout << vertex << " "; builder.add_vertex_to_facet(vertex); } // std::cout << std::endl; builder.end_facet(); } builder.end_surface(); */ }