Method fillet_loop

src/ifcgeom/profile_helper.cpp:5–55

using namespace ifcopenshell::geometry;

taxonomy::loop::ptr ifcopenshell::geometry::fillet_loop(taxonomy::loop::ptr loop, double radius) {
	std::vector<profile_point_with_edges_3d> pps(loop->children.size());
	for (int b = 0; b < loop->children.size(); ++b) {
		int c = (b - 1) % loop->children.size();
		pps[b] = { 
			boost::get<taxonomy::point3::ptr>(loop->children[c]->start)->ccomponents(), 
			radius, loop->children[c], loop->children[b]
		};
	}
	size_t i = pps.size();
	while (i--) {
		const auto& p = pps[i];
		if (p.radius && *p.radius > 0.) {

			auto p0 = boost::get<taxonomy::point3::ptr>(p.previous->start)->ccomponents();
			auto p1a = boost::get<taxonomy::point3::ptr>(p.previous->end)->ccomponents();
			auto p2 = boost::get<taxonomy::point3::ptr>(p.next->end)->ccomponents();
			auto p1b = boost::get<taxonomy::point3::ptr>(p.next->start)->ccomponents();

			auto ba_ = p0 - p1a;
			auto bc_ = p2 - p1b;

			auto ba = ba_.normalized();
			auto bc = bc_.normalized();

			const double angle = std::acos(ba.dot(bc));
			const double inset = *p.radius / std::tan(angle / 2.);

			boost::get<taxonomy::point3::ptr>(p.previous->end)->components() += ba * inset;
			boost::get<taxonomy::point3::ptr>(p.next->start)->components() += bc * inset;

			auto e = taxonomy::make<taxonomy::edge>();
			e->start = p.previous->end;
			e->end = p.next->start;

			// @todo untested from here.

			auto ab = ba.cross(bc);

			auto O = boost::get<taxonomy::point3::ptr>(p.previous->end)->ccomponents().head<3>() + ab * *p.radius;

			auto c = taxonomy::make<taxonomy::circle>();
			c->matrix = taxonomy::make<taxonomy::matrix4>(O, ab);
			c->radius = *p.radius;
			e->basis = c;

			loop->children.insert(std::find(loop->children.begin(), loop->children.end(), p.next), e);
		}
	};
	return loop;
}

void ifcopenshell::geometry::remove_duplicate_points_from_loop(std::vector<taxonomy::point3::ptr>& polygon, bool closed, double tol) {
	tol *= tol;