2014-05-02 16:46:22 +00:00
|
|
|
#include "Geometry.hpp"
|
2013-07-16 19:04:14 +00:00
|
|
|
#include "Line.hpp"
|
2013-11-21 14:12:06 +00:00
|
|
|
#include "Polyline.hpp"
|
2013-07-16 19:04:14 +00:00
|
|
|
#include <algorithm>
|
2014-03-04 22:33:13 +00:00
|
|
|
#include <cmath>
|
2014-01-17 13:22:37 +00:00
|
|
|
#include <sstream>
|
2013-07-16 19:04:14 +00:00
|
|
|
|
|
|
|
namespace Slic3r {
|
|
|
|
|
2018-08-28 07:03:03 +00:00
|
|
|
Linef3 transform(const Linef3& line, const Transform3d& t)
|
|
|
|
{
|
|
|
|
typedef Eigen::Matrix<double, 3, 2> LineInMatrixForm;
|
|
|
|
|
|
|
|
LineInMatrixForm world_line;
|
|
|
|
::memcpy((void*)world_line.col(0).data(), (const void*)line.a.data(), 3 * sizeof(double));
|
|
|
|
::memcpy((void*)world_line.col(1).data(), (const void*)line.b.data(), 3 * sizeof(double));
|
|
|
|
|
|
|
|
LineInMatrixForm local_line = t * world_line.colwise().homogeneous();
|
|
|
|
return Linef3(Vec3d(local_line(0, 0), local_line(1, 0), local_line(2, 0)), Vec3d(local_line(0, 1), local_line(1, 1), local_line(2, 1)));
|
|
|
|
}
|
|
|
|
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
bool Line::intersection_infinite(const Line &other, Point* point) const
|
2015-01-06 19:52:36 +00:00
|
|
|
{
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
Vec2d a1 = this->a.cast<double>();
|
|
|
|
Vec2d v12 = (other.a - this->a).cast<double>();
|
|
|
|
Vec2d v1 = (this->b - this->a).cast<double>();
|
|
|
|
Vec2d v2 = (other.b - other.a).cast<double>();
|
|
|
|
double denom = cross2(v1, v2);
|
|
|
|
if (std::fabs(denom) < EPSILON)
|
2015-01-16 15:25:39 +00:00
|
|
|
return false;
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
double t1 = cross2(v12, v2) / denom;
|
|
|
|
*point = (a1 + t1 * v1).cast<coord_t>();
|
2015-01-16 15:25:39 +00:00
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
double Line::perp_distance_to(const Point &point) const
|
2014-03-04 22:33:13 +00:00
|
|
|
{
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
const Line &line = *this;
|
|
|
|
const Vec2d v = (line.b - line.a).cast<double>();
|
|
|
|
const Vec2d va = (point - line.a).cast<double>();
|
|
|
|
if (line.a == line.b)
|
|
|
|
return va.norm();
|
|
|
|
return std::abs(cross2(v, va)) / v.norm();
|
2014-03-04 22:33:13 +00:00
|
|
|
}
|
|
|
|
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
double Line::orientation() const
|
2014-08-03 13:03:11 +00:00
|
|
|
{
|
|
|
|
double angle = this->atan2_();
|
|
|
|
if (angle < 0) angle = 2*PI + angle;
|
|
|
|
return angle;
|
|
|
|
}
|
|
|
|
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
double Line::direction() const
|
2014-03-04 22:33:13 +00:00
|
|
|
{
|
|
|
|
double atan2 = this->atan2_();
|
2014-08-04 12:55:13 +00:00
|
|
|
return (fabs(atan2 - PI) < EPSILON) ? 0
|
2014-03-04 22:33:13 +00:00
|
|
|
: (atan2 < 0) ? (atan2 + PI)
|
|
|
|
: atan2;
|
|
|
|
}
|
|
|
|
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
bool Line::parallel_to(double angle) const
|
2014-03-05 17:43:01 +00:00
|
|
|
{
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
return Slic3r::Geometry::directions_parallel(this->direction(), angle);
|
2016-03-19 14:33:58 +00:00
|
|
|
}
|
|
|
|
|
2021-10-22 11:51:33 +00:00
|
|
|
bool Line::parallel_to(const Line& line) const
|
|
|
|
{
|
|
|
|
const Vec2d v1 = (this->b - this->a).cast<double>();
|
|
|
|
const Vec2d v2 = (line.b - line.a).cast<double>();
|
|
|
|
return std::fabs(cross2(v1, v2)) < EPSILON;
|
|
|
|
}
|
|
|
|
|
2021-09-21 11:51:57 +00:00
|
|
|
#if ENABLE_OUT_OF_BED_DETECTION_IMPROVEMENTS
|
|
|
|
bool Line::perpendicular_to(double angle) const
|
|
|
|
{
|
|
|
|
return Slic3r::Geometry::directions_perpendicular(this->direction(), angle);
|
|
|
|
}
|
2021-10-22 11:51:33 +00:00
|
|
|
|
|
|
|
bool Line::perpendicular_to(const Line& line) const
|
|
|
|
{
|
|
|
|
const Vec2d v1 = (this->b - this->a).cast<double>();
|
|
|
|
const Vec2d v2 = (line.b - line.a).cast<double>();
|
|
|
|
return std::fabs(v1.dot(v2)) < EPSILON;
|
|
|
|
}
|
2021-09-21 11:51:57 +00:00
|
|
|
#endif // ENABLE_OUT_OF_BED_DETECTION_IMPROVEMENTS
|
|
|
|
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
bool Line::intersection(const Line &l2, Point *intersection) const
|
|
|
|
{
|
|
|
|
const Line &l1 = *this;
|
|
|
|
const Vec2d v1 = (l1.b - l1.a).cast<double>();
|
|
|
|
const Vec2d v2 = (l2.b - l2.a).cast<double>();
|
|
|
|
double denom = cross2(v1, v2);
|
|
|
|
if (fabs(denom) < EPSILON)
|
|
|
|
#if 0
|
|
|
|
// Lines are collinear. Return true if they are coincident (overlappign).
|
|
|
|
return ! (fabs(nume_a) < EPSILON && fabs(nume_b) < EPSILON);
|
|
|
|
#else
|
|
|
|
return false;
|
|
|
|
#endif
|
2019-10-15 07:40:40 +00:00
|
|
|
const Vec2d v12 = (l1.a - l2.a).cast<double>();
|
|
|
|
double nume_a = cross2(v2, v12);
|
|
|
|
double nume_b = cross2(v1, v12);
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
double t1 = nume_a / denom;
|
|
|
|
double t2 = nume_b / denom;
|
|
|
|
if (t1 >= 0 && t1 <= 1.0f && t2 >= 0 && t2 <= 1.0f) {
|
2016-03-19 14:33:58 +00:00
|
|
|
// Get the intersection point.
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
(*intersection) = (l1.a.cast<double>() + t1 * v1).cast<coord_t>();
|
2016-03-19 14:33:58 +00:00
|
|
|
return true;
|
|
|
|
}
|
|
|
|
return false; // not intersecting
|
|
|
|
}
|
|
|
|
|
2019-11-22 17:22:44 +00:00
|
|
|
bool Line::clip_with_bbox(const BoundingBox &bbox)
|
|
|
|
{
|
|
|
|
Vec2d x0clip, x1clip;
|
|
|
|
bool result = Geometry::liang_barsky_line_clipping<double>(this->a.cast<double>(), this->b.cast<double>(), BoundingBoxf(bbox.min.cast<double>(), bbox.max.cast<double>()), x0clip, x1clip);
|
|
|
|
if (result) {
|
|
|
|
this->a = x0clip.cast<coord_t>();
|
|
|
|
this->b = x1clip.cast<coord_t>();
|
|
|
|
}
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
2020-10-20 07:17:26 +00:00
|
|
|
void Line::extend(double offset)
|
2020-10-10 20:25:51 +00:00
|
|
|
{
|
|
|
|
Vector offset_vector = (offset * this->vector().cast<double>().normalized()).cast<coord_t>();
|
|
|
|
this->a -= offset_vector;
|
|
|
|
this->b += offset_vector;
|
|
|
|
}
|
|
|
|
|
2018-08-21 15:43:05 +00:00
|
|
|
Vec3d Linef3::intersect_plane(double z) const
|
2014-12-16 00:12:37 +00:00
|
|
|
{
|
Removed Point::scale(),translate(),coincides_with(),distance_to(),
distance_to_squared(),perp_distance_to(),negative(),vector_to(),
translate(), distance_to() etc,
replaced with the Eigen equivalents.
2018-08-17 12:14:24 +00:00
|
|
|
auto v = (this->b - this->a).cast<double>();
|
2018-08-17 13:53:43 +00:00
|
|
|
double t = (z - this->a(2)) / v(2);
|
2018-08-21 15:43:05 +00:00
|
|
|
return Vec3d(this->a(0) + v(0) * t, this->a(1) + v(1) * t, z);
|
2014-12-16 00:12:37 +00:00
|
|
|
}
|
|
|
|
|
2020-05-28 13:53:53 +00:00
|
|
|
BoundingBox get_extents(const Lines &lines)
|
|
|
|
{
|
|
|
|
BoundingBox bbox;
|
|
|
|
for (const Line &line : lines) {
|
|
|
|
bbox.merge(line.a);
|
|
|
|
bbox.merge(line.b);
|
|
|
|
}
|
|
|
|
return bbox;
|
|
|
|
}
|
|
|
|
|
2020-06-11 14:09:51 +00:00
|
|
|
} // namespace Slic3r
|