2017-07-27 08:39:43 +00:00
# include <stdlib.h>
# include <stdint.h>
# include <algorithm>
# include <cmath>
# include <limits>
# include <boost/static_assert.hpp>
# include "../ClipperUtils.hpp"
# include "../ExPolygon.hpp"
# include "../Geometry.hpp"
# include "../Surface.hpp"
# include "../Int128.hpp"
# include "FillRectilinear3.hpp"
2019-06-10 14:53:08 +00:00
// #define SLIC3R_DEBUG
2017-07-27 08:39:43 +00:00
// Make assert active if SLIC3R_DEBUG
# ifdef SLIC3R_DEBUG
# undef NDEBUG
2017-07-28 13:47:59 +00:00
# define DEBUG
# define _DEBUG
2018-11-26 13:54:23 +00:00
# include "../SVG.hpp"
2017-07-27 08:39:43 +00:00
# endif
# include <cassert>
namespace Slic3r {
namespace FillRectilinear3_Internal {
// A container maintaining the source expolygon with its inner offsetted polygon.
// The source expolygon is offsetted twice:
// 1) A tiny offset is used to get a contour, to which the open hatching lines will be extended.
// 2) A larger offset is used to get a contor, along which the individual hatching lines will be connected.
struct ExPolygonWithOffset
{
public :
ExPolygonWithOffset (
const ExPolygon & expolygon ,
float aoffset1 ,
float aoffset2 )
{
// Copy and rotate the source polygons.
polygons_src = expolygon ;
double mitterLimit = 3. ;
// for the infill pattern, don't cut the corners.
// default miterLimt = 3
//double mitterLimit = 10.;
2017-07-28 13:47:59 +00:00
assert ( aoffset1 < 0 ) ;
assert ( aoffset2 < 0 ) ;
assert ( aoffset2 < aoffset1 ) ;
2017-07-27 08:39:43 +00:00
// bool sticks_removed = remove_sticks(polygons_src);
// if (sticks_removed) printf("Sticks removed!\n");
polygons_outer = offset ( polygons_src , aoffset1 ,
ClipperLib : : jtMiter ,
mitterLimit ) ;
polygons_inner = offset ( polygons_outer , aoffset2 - aoffset1 ,
ClipperLib : : jtMiter ,
mitterLimit ) ;
// Filter out contours with zero area or small area, contours with 2 points only.
const double min_area_threshold = 0.01 * aoffset2 * aoffset2 ;
remove_small ( polygons_outer , min_area_threshold ) ;
remove_small ( polygons_inner , min_area_threshold ) ;
remove_sticks ( polygons_outer ) ;
remove_sticks ( polygons_inner ) ;
n_contours_outer = polygons_outer . size ( ) ;
n_contours_inner = polygons_inner . size ( ) ;
n_contours = n_contours_outer + n_contours_inner ;
polygons_ccw . assign ( n_contours , false ) ;
for ( size_t i = 0 ; i < n_contours ; + + i ) {
contour ( i ) . remove_duplicate_points ( ) ;
2017-07-28 13:47:59 +00:00
assert ( ! contour ( i ) . has_duplicate_points ( ) ) ;
2017-07-27 08:39:43 +00:00
polygons_ccw [ i ] = Slic3r : : Geometry : : is_ccw ( contour ( i ) ) ;
}
}
// Any contour with offset1
bool is_contour_outer ( size_t idx ) const { return idx < n_contours_outer ; }
// Any contour with offset2
bool is_contour_inner ( size_t idx ) const { return idx > = n_contours_outer ; }
const Polygon & contour ( size_t idx ) const
{ return is_contour_outer ( idx ) ? polygons_outer [ idx ] : polygons_inner [ idx - n_contours_outer ] ; }
Polygon & contour ( size_t idx )
{ return is_contour_outer ( idx ) ? polygons_outer [ idx ] : polygons_inner [ idx - n_contours_outer ] ; }
bool is_contour_ccw ( size_t idx ) const { return polygons_ccw [ idx ] ! = 0 ; }
BoundingBox bounding_box_src ( ) const
{ return get_extents ( polygons_src ) ; }
BoundingBox bounding_box_outer ( ) const
{ return get_extents ( polygons_outer ) ; }
BoundingBox bounding_box_inner ( ) const
{ return get_extents ( polygons_inner ) ; }
# ifdef SLIC3R_DEBUG
void export_to_svg ( Slic3r : : SVG & svg ) const {
svg . draw_outline ( polygons_src , " black " ) ;
svg . draw_outline ( polygons_outer , " green " ) ;
svg . draw_outline ( polygons_inner , " brown " ) ;
}
# endif /* SLIC3R_DEBUG */
ExPolygon polygons_src ;
Polygons polygons_outer ;
Polygons polygons_inner ;
size_t n_contours_outer ;
size_t n_contours_inner ;
size_t n_contours ;
protected :
// For each polygon of polygons_inner, remember its orientation.
std : : vector < unsigned char > polygons_ccw ;
} ;
class SegmentedIntersectionLine ;
// Intersection point of a vertical line with a polygon segment.
class SegmentIntersection
{
public :
SegmentIntersection ( ) :
line ( nullptr ) ,
expoly_with_offset ( nullptr ) ,
iContour ( 0 ) ,
iSegment ( 0 ) ,
type ( UNKNOWN ) ,
consumed_vertical_up ( false ) ,
consumed_perimeter_right ( false )
{ }
// Parent object owning this intersection point.
const SegmentedIntersectionLine * line ;
// Container with the source expolygon and its shrank copies, to be intersected by the line.
const ExPolygonWithOffset * expoly_with_offset ;
// Index of a contour in ExPolygonWithOffset, with which this vertical line intersects.
size_t iContour ;
// Index of a segment in iContour, with which this vertical line intersects.
size_t iSegment ;
// Kind of intersection. With the original contour, or with the inner offestted contour?
// A vertical segment will be at least intersected by OUTER_LOW, OUTER_HIGH,
// but it could be intersected with OUTER_LOW, INNER_LOW, INNER_HIGH, OUTER_HIGH,
// and there may be more than one pair of INNER_LOW, INNER_HIGH between OUTER_LOW, OUTER_HIGH.
enum SegmentIntersectionType {
OUTER_LOW = 0 ,
OUTER_HIGH = 1 ,
INNER_LOW = 2 ,
INNER_HIGH = 3 ,
UNKNOWN = - 1
} ;
SegmentIntersectionType type ;
// For the INNER_LOW type, this point may be connected to another INNER_LOW point following a perimeter contour.
// For the INNER_HIGH type, this point may be connected to another INNER_HIGH point following a perimeter contour.
// If INNER_LOW is connected to INNER_HIGH or vice versa,
// one has to make sure the vertical infill line does not overlap with the connecting perimeter line.
bool is_inner ( ) const { return type = = INNER_LOW | | type = = INNER_HIGH ; }
bool is_outer ( ) const { return type = = OUTER_LOW | | type = = OUTER_HIGH ; }
bool is_low ( ) const { return type = = INNER_LOW | | type = = OUTER_LOW ; }
bool is_high ( ) const { return type = = INNER_HIGH | | type = = OUTER_HIGH ; }
// Calculate a position of this intersection point. The position does not need to be necessary exact.
Point pos ( ) const ;
// Returns 0, if this and other segments intersect at the hatching line.
// Returns -1, if this intersection is below the other intersection on the hatching line.
// Returns +1 otherwise.
int ordering_along_line ( const SegmentIntersection & other ) const ;
// Compare two y intersection points given by rational numbers.
2017-07-28 13:47:59 +00:00
bool operator < ( const SegmentIntersection & other ) const ;
// { return this->ordering_along_line(other) == -1; }
2017-07-27 08:39:43 +00:00
bool operator = = ( const SegmentIntersection & other ) const { return this - > ordering_along_line ( other ) = = 0 ; }
//FIXME legacy code, suporting the old graph traversal algorithm. Please remove.
// Was this segment along the y axis consumed?
// Up means up along the vertical segment.
bool consumed_vertical_up ;
// Was a segment of the inner perimeter contour consumed?
// Right means right from the vertical segment.
bool consumed_perimeter_right ;
} ;
// A single hathing line intersecting the ExPolygonWithOffset.
class SegmentedIntersectionLine
{
public :
// Index of this vertical intersection line.
size_t idx ;
// Position of the line along the X axis of the oriented bounding box.
2017-07-28 13:47:59 +00:00
// coord_t x;
2017-07-27 08:39:43 +00:00
// Position of this vertical intersection line, rotated to the world coordinate system.
Point pos ;
// Direction of this vertical intersection line, rotated to the world coordinate system. The direction is not normalized to maintain a sufficient accuracy!
Vector dir ;
// List of intersection points with polygons, sorted increasingly by the y axis.
// The SegmentIntersection keeps a pointer to this object to access the start and direction of this line.
std : : vector < SegmentIntersection > intersections ;
} ;
// Return an intersection point of the parent SegmentedIntersectionLine with the segment of a parent ExPolygonWithOffset.
// The intersected segment of the ExPolygonWithOffset is addressed with (iContour, iSegment).
// When calling this method, the SegmentedIntersectionLine must not be parallel with the segment.
Point SegmentIntersection : : pos ( ) const
{
// Get the two rays to be intersected.
const Polygon & poly = this - > expoly_with_offset - > contour ( this - > iContour ) ;
// 30 bits + 1 signum bit.
2017-07-28 13:47:59 +00:00
const Point & seg_start = poly . points [ ( this - > iSegment = = 0 ) ? poly . points . size ( ) - 1 : this - > iSegment - 1 ] ;
const Point & seg_end = poly . points [ this - > iSegment ] ;
2017-07-27 08:39:43 +00:00
// Point, vector of the segment.
2018-08-21 19:05:24 +00:00
const Vec2d p1 ( seg_start . cast < coordf_t > ( ) ) ;
const Vec2d v1 ( ( seg_end - seg_start ) . cast < coordf_t > ( ) ) ;
2017-07-27 08:39:43 +00:00
// Point, vector of this hatching line.
2018-08-21 19:05:24 +00:00
const Vec2d p2 ( line - > pos . cast < coordf_t > ( ) ) ;
const Vec2d v2 ( line - > dir . cast < coordf_t > ( ) ) ;
2017-07-27 08:39:43 +00:00
// Intersect the two rays.
2018-08-17 13:53:43 +00:00
double denom = v1 ( 0 ) * v2 ( 1 ) - v2 ( 0 ) * v1 ( 1 ) ;
2017-07-27 08:39:43 +00:00
Point out ;
if ( denom = = 0. ) {
// Lines are collinear. As the pos() method is not supposed to be called on collinear vectors,
// the source vectors are not quite collinear. Return the center of the contour segment.
out = seg_start + seg_end ;
2018-08-17 13:53:43 +00:00
out ( 0 ) > > = 1 ;
out ( 1 ) > > = 1 ;
2017-07-27 08:39:43 +00:00
} else {
// Find the intersection point.
2018-08-17 13:53:43 +00:00
double t = ( v2 ( 0 ) * ( p1 ( 1 ) - p2 ( 1 ) ) - v2 ( 1 ) * ( p1 ( 0 ) - p2 ( 0 ) ) ) / denom ;
2017-07-27 08:39:43 +00:00
if ( t < 0. )
out = seg_start ;
else if ( t > 1. )
out = seg_end ;
else {
2018-08-17 13:53:43 +00:00
out ( 0 ) = coord_t ( floor ( p1 ( 0 ) + t * v1 ( 0 ) + 0.5 ) ) ;
out ( 1 ) = coord_t ( floor ( p1 ( 1 ) + t * v1 ( 1 ) + 0.5 ) ) ;
2017-07-27 08:39:43 +00:00
}
}
return out ;
}
static inline int signum ( int64_t v ) { return ( v > 0 ) - ( v < 0 ) ; }
// Returns 0, if this and other segments intersect at the hatching line.
// Returns -1, if this intersection is below the other intersection on the hatching line.
// Returns +1 otherwise.
int SegmentIntersection : : ordering_along_line ( const SegmentIntersection & other ) const
{
assert ( this - > line = = other . line ) ;
assert ( this - > expoly_with_offset = = other . expoly_with_offset ) ;
if ( this - > iContour = = other . iContour & & this - > iSegment = = other . iSegment )
return true ;
// Segment of this
const Polygon & poly_a = this - > expoly_with_offset - > contour ( this - > iContour ) ;
// 30 bits + 1 signum bit.
2017-07-28 13:47:59 +00:00
const Point & seg_start_a = poly_a . points [ ( this - > iSegment = = 0 ) ? poly_a . points . size ( ) - 1 : this - > iSegment - 1 ] ;
const Point & seg_end_a = poly_a . points [ this - > iSegment ] ;
2017-07-27 08:39:43 +00:00
// Segment of other
const Polygon & poly_b = this - > expoly_with_offset - > contour ( other . iContour ) ;
// 30 bits + 1 signum bit.
2017-07-28 13:47:59 +00:00
const Point & seg_start_b = poly_b . points [ ( other . iSegment = = 0 ) ? poly_b . points . size ( ) - 1 : other . iSegment - 1 ] ;
const Point & seg_end_b = poly_b . points [ other . iSegment ] ;
2017-07-27 08:39:43 +00:00
if ( this - > iContour = = other . iContour ) {
if ( ( this - > iSegment + 1 ) % poly_a . points . size ( ) = = other . iSegment ) {
// other.iSegment succeeds this->iSegment
2017-07-28 13:47:59 +00:00
assert ( seg_end_a = = seg_start_b ) ;
// Avoid calling the 128bit x 128bit multiplication below if this->line intersects the common 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
if ( cross2 ( Vec2i64 ( this - > line - > dir . cast < int64_t > ( ) ) , ( seg_end_b - this - > line - > pos ) . cast < int64_t > ( ) ) = = 0 )
2017-07-28 13:47:59 +00:00
return 0 ;
2017-07-27 08:39:43 +00:00
} else if ( ( other . iSegment + 1 ) % poly_a . points . size ( ) = = this - > iSegment ) {
// this->iSegment succeeds other.iSegment
2017-07-28 13:47:59 +00:00
assert ( seg_start_a = = seg_end_b ) ;
// Avoid calling the 128bit x 128bit multiplication below if this->line intersects the common 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
if ( cross2 ( Vec2i64 ( this - > line - > dir . cast < int64_t > ( ) ) , ( seg_start_a - this - > line - > pos ) . cast < int64_t > ( ) ) = = 0 )
2017-07-28 13:47:59 +00:00
return 0 ;
2017-07-27 08:39:43 +00:00
} else {
// General case.
}
}
// First test, whether both points of one segment are completely in one half-plane of the other line.
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 Vec2i64 vec_b = ( seg_end_b - seg_start_b ) . cast < int64_t > ( ) ;
int side_start = signum ( cross2 ( vec_b , ( seg_start_a - seg_start_b ) . cast < int64_t > ( ) ) ) ;
int side_end = signum ( cross2 ( vec_b , ( seg_end_a - seg_start_b ) . cast < int64_t > ( ) ) ) ;
2017-07-27 08:39:43 +00:00
int side = side_start * side_end ;
if ( side > 0 )
// This segment is completely inside one half-plane of the other line, therefore the ordering is trivial.
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 signum ( cross2 ( vec_b , this - > line - > dir . cast < int64_t > ( ) ) ) * side_start ;
2017-07-27 08:39:43 +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 Vec2i64 vec_a = ( seg_end_a - seg_start_a ) . cast < int64_t > ( ) ;
int side_start2 = signum ( cross2 ( vec_a , ( seg_start_b - seg_start_a ) . cast < int64_t > ( ) ) ) ;
int side_end2 = signum ( cross2 ( vec_a , ( seg_end_b - seg_start_a ) . cast < int64_t > ( ) ) ) ;
2017-07-27 08:39:43 +00:00
int side2 = side_start2 * side_end2 ;
2017-07-28 13:47:59 +00:00
//if (side == 0 && side2 == 0)
// The segments share one of their end points.
2017-07-27 08:39:43 +00:00
if ( side2 > 0 )
// This segment is completely inside one half-plane of the other line, therefore the ordering is trivial.
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 signum ( cross2 ( this - > line - > dir . cast < int64_t > ( ) , vec_a ) ) * side_start2 ;
2017-07-27 08:39:43 +00:00
// The two segments intersect and they are not sucessive segments of the same contour.
// Ordering of the points depends on the position of the segment intersection (left / right from this->line),
// therefore a simple test over the input segment end points is not sufficient.
// Find the parameters of intersection of the two segmetns with this->line.
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
int64_t denom1 = cross2 ( this - > line - > dir . cast < int64_t > ( ) , vec_a ) ;
int64_t denom2 = cross2 ( this - > line - > dir . cast < int64_t > ( ) , vec_b ) ;
Vec2i64 vx_a = ( seg_start_a - this - > line - > pos ) . cast < int64_t > ( ) ;
Vec2i64 vx_b = ( seg_start_b - this - > line - > pos ) . cast < int64_t > ( ) ;
2018-08-17 13:53:43 +00:00
int64_t t1_times_denom1 = vx_a ( 0 ) * vec_a ( 1 ) - vx_a ( 1 ) * vec_a ( 0 ) ;
int64_t t2_times_denom2 = vx_b ( 0 ) * vec_b ( 1 ) - vx_b ( 1 ) * vec_b ( 0 ) ;
2017-07-28 13:47:59 +00:00
assert ( denom1 ! = 0 ) ;
2017-07-27 08:39:43 +00:00
assert ( denom2 ! = 0 ) ;
return Int128 : : compare_rationals_filtered ( t1_times_denom1 , denom1 , t2_times_denom2 , denom2 ) ;
}
2017-07-28 13:47:59 +00:00
// Compare two y intersection points given by rational numbers.
bool SegmentIntersection : : operator < ( const SegmentIntersection & other ) const
{
# ifdef _DEBUG
Point p1 = this - > pos ( ) ;
Point p2 = other . pos ( ) ;
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
int64_t d = this - > line - > dir . cast < int64_t > ( ) . dot ( ( p2 - p1 ) . cast < int64_t > ( ) ) ;
2017-07-28 13:47:59 +00:00
# endif /* _DEBUG */
int ordering = this - > ordering_along_line ( other ) ;
# ifdef _DEBUG
if ( ordering = = - 1 )
assert ( d > = - int64_t ( SCALED_EPSILON ) ) ;
else if ( ordering = = 1 )
assert ( d < = int64_t ( SCALED_EPSILON ) ) ;
# endif /* _DEBUG */
return ordering = = - 1 ;
}
2017-07-27 08:39:43 +00:00
// When doing a rectilinear / grid / triangle / stars / cubic infill,
// the following class holds the hatching lines of each of the hatching directions.
class InfillHatchingSingleDirection
{
public :
// Hatching angle, CCW from the X axis.
double angle ;
// Starting point of the 1st hatching line.
Point start_point ;
// Direction vector, its size is not normalized to maintain a sufficient accuracy!
Vector direction ;
// Spacing of the hatching lines, perpendicular to the direction vector.
coord_t line_spacing ;
// Infill segments oriented at angle.
std : : vector < SegmentedIntersectionLine > segs ;
} ;
// For the rectilinear, grid, triangles, stars and cubic pattern fill one InfillHatchingSingleDirection structure
// for each infill direction. The segments stored in InfillHatchingSingleDirection will then form a graph of candidate
// paths to be extruded.
static bool prepare_infill_hatching_segments (
// Input geometry to be hatch, containing two concentric contours for each input contour.
const ExPolygonWithOffset & poly_with_offset ,
// fill density, dont_adjust
const FillParams & params ,
// angle, pattern_shift, spacing
FillRectilinear3 : : FillDirParams & fill_dir_params ,
// Reference point of the pattern, to which the infill lines will be alligned, and the base angle.
const std : : pair < float , Point > & rotate_vector ,
// Resulting straight segments of the infill graph.
InfillHatchingSingleDirection & out )
{
out . angle = rotate_vector . first + fill_dir_params . angle ;
2017-07-28 13:47:59 +00:00
out . direction = Point ( coord_t ( scale_ ( 1000 ) ) , coord_t ( 0 ) ) ;
2017-07-27 08:39:43 +00:00
// Hatch along the Y axis of the rotated coordinate system.
out . direction . rotate ( out . angle + 0.5 * M_PI ) ;
out . segs . clear ( ) ;
2017-07-28 13:47:59 +00:00
assert ( params . density > 0.0001f & & params . density < = 1.f ) ;
2017-07-27 08:39:43 +00:00
coord_t line_spacing = coord_t ( scale_ ( fill_dir_params . spacing ) / params . density ) ;
// Bounding box around the source contour, aligned with out.angle.
BoundingBox bounding_box = get_extents_rotated ( poly_with_offset . polygons_src . contour , - out . angle ) ;
// Define the flow spacing according to requested density.
if ( params . full_infill ( ) & & ! params . dont_adjust ) {
// Full infill, adjust the line spacing to fit an integer number of lines.
2018-08-17 13:53:43 +00:00
out . line_spacing = Fill : : _adjust_solid_spacing ( bounding_box . size ( ) ( 0 ) , line_spacing ) ;
2017-07-27 08:39:43 +00:00
// Report back the adjusted line spacing.
2018-08-21 15:43:05 +00:00
fill_dir_params . spacing = unscale < double > ( line_spacing ) ;
2017-07-27 08:39:43 +00:00
} else {
// Extend bounding box so that our pattern will be aligned with the other layers.
// Transform the reference point to the rotated coordinate system.
Point refpt = rotate_vector . second . rotated ( - out . angle ) ;
// _align_to_grid will not work correctly with positive pattern_shift.
coord_t pattern_shift_scaled = coord_t ( scale_ ( fill_dir_params . pattern_shift ) ) % line_spacing ;
2018-08-17 13:53:43 +00:00
refpt ( 0 ) - = ( pattern_shift_scaled > = 0 ) ? pattern_shift_scaled : ( line_spacing + pattern_shift_scaled ) ;
2017-07-27 08:39:43 +00:00
bounding_box . merge ( Fill : : _align_to_grid (
bounding_box . min ,
Point ( line_spacing , line_spacing ) ,
refpt ) ) ;
}
// Intersect a set of euqally spaced vertical lines wiht expolygon.
// n_vlines = ceil(bbox_width / line_spacing)
2018-08-17 13:53:43 +00:00
size_t n_vlines = ( bounding_box . max ( 0 ) - bounding_box . min ( 0 ) + line_spacing - 1 ) / line_spacing ;
coord_t x0 = bounding_box . min ( 0 ) ;
2017-07-27 08:39:43 +00:00
if ( params . full_infill ( ) )
x0 + = coord_t ( ( line_spacing + SCALED_EPSILON ) / 2 ) ;
out . line_spacing = line_spacing ;
2018-08-17 13:53:43 +00:00
out . start_point = Point ( x0 , bounding_box . min ( 1 ) ) ;
2017-07-27 08:39:43 +00:00
out . start_point . rotate ( out . angle ) ;
# ifdef SLIC3R_DEBUG
static int iRun = 0 ;
BoundingBox bbox_svg = poly_with_offset . bounding_box_outer ( ) ;
: : Slic3r : : SVG svg ( debug_out_path ( " FillRectilinear2-%d.svg " , iRun ) , bbox_svg ) ; // , scale_(1.));
poly_with_offset . export_to_svg ( svg ) ;
{
: : Slic3r : : SVG svg ( debug_out_path ( " FillRectilinear2-initial-%d.svg " , iRun ) , bbox_svg ) ; // , scale_(1.));
poly_with_offset . export_to_svg ( svg ) ;
}
iRun + + ;
# endif /* SLIC3R_DEBUG */
// For each contour
// Allocate storage for the segments.
out . segs . assign ( n_vlines , SegmentedIntersectionLine ( ) ) ;
2017-07-28 13:47:59 +00:00
double cos_a = cos ( out . angle ) ;
double sin_a = sin ( out . angle ) ;
2017-07-27 08:39:43 +00:00
for ( size_t i = 0 ; i < n_vlines ; + + i ) {
auto & seg = out . segs [ i ] ;
seg . idx = i ;
2018-08-17 13:53:43 +00:00
// seg(0) = x0 + coord_t(i) * line_spacing;
2017-07-28 13:47:59 +00:00
coord_t x = x0 + coord_t ( i ) * line_spacing ;
2018-08-17 13:53:43 +00:00
seg . pos ( 0 ) = coord_t ( floor ( cos_a * x - sin_a * bounding_box . min ( 1 ) + 0.5 ) ) ;
seg . pos ( 1 ) = coord_t ( floor ( cos_a * bounding_box . min ( 1 ) + sin_a * x + 0.5 ) ) ;
2017-07-27 08:39:43 +00:00
seg . dir = out . direction ;
}
for ( size_t iContour = 0 ; iContour < poly_with_offset . n_contours ; + + iContour ) {
const Points & contour = poly_with_offset . contour ( iContour ) . points ;
if ( contour . size ( ) < 2 )
continue ;
// For each segment
for ( size_t iSegment = 0 ; iSegment < contour . size ( ) ; + + iSegment ) {
size_t iPrev = ( ( iSegment = = 0 ) ? contour . size ( ) : iSegment ) - 1 ;
const Point * pl = & contour [ iPrev ] ;
const Point * pr = & contour [ iSegment ] ;
// Orient the segment to the direction vector.
const Point v = * pr - * pl ;
2018-08-17 13:53:43 +00:00
int orientation = Int128 : : sign_determinant_2x2_filtered ( v ( 0 ) , v ( 1 ) , out . direction ( 0 ) , out . direction ( 1 ) ) ;
2017-07-27 08:39:43 +00:00
if ( orientation = = 0 )
// Ignore strictly vertical segments.
continue ;
if ( orientation < 0 )
// Always orient the input segment consistently towards the hatching direction.
std : : swap ( pl , pr ) ;
// Which of the equally spaced vertical lines is intersected by this segment?
2018-08-17 13:53:43 +00:00
coord_t l = ( coord_t ) floor ( cos_a * ( * pl ) ( 0 ) + sin_a * ( * pl ) ( 1 ) - SCALED_EPSILON ) ;
coord_t r = ( coord_t ) ceil ( cos_a * ( * pr ) ( 0 ) + sin_a * ( * pr ) ( 1 ) + SCALED_EPSILON ) ;
2017-07-28 13:47:59 +00:00
assert ( l < r - SCALED_EPSILON ) ;
2017-07-27 08:39:43 +00:00
// il, ir are the left / right indices of vertical lines intersecting a segment
2017-07-28 13:47:59 +00:00
int il = std : : max < int > ( 0 , ( l - x0 + line_spacing ) / line_spacing ) ;
int ir = std : : min < int > ( int ( out . segs . size ( ) ) - 1 , ( r - x0 ) / line_spacing ) ;
2017-07-27 08:39:43 +00:00
// The previous tests were done with floating point arithmetics over an epsilon-extended interval.
// Now do the same tests with exact arithmetics over the exact interval.
2018-05-17 08:37:26 +00:00
while ( il < = ir & & int128 : : orient ( out . segs [ il ] . pos , out . segs [ il ] . pos + out . direction , * pl ) < 0 )
2017-07-27 08:39:43 +00:00
+ + il ;
2018-05-17 08:37:26 +00:00
while ( il < = ir & & int128 : : orient ( out . segs [ ir ] . pos , out . segs [ ir ] . pos + out . direction , * pr ) > 0 )
2017-07-27 08:39:43 +00:00
- - ir ;
// Here it is ensured, that
// 1) out.seg is not parallel to (pl, pr)
// 2) all lines from il to ir intersect <pl, pr>.
2017-07-28 13:47:59 +00:00
assert ( il > = 0 & & ir < int ( out . segs . size ( ) ) ) ;
2017-07-27 08:39:43 +00:00
for ( int i = il ; i < = ir ; + + i ) {
2018-08-17 13:53:43 +00:00
// assert(out.segs[i](0) == i * line_spacing + x0);
// assert(l <= out.segs[i](0));
// assert(r >= out.segs[i](0));
2017-07-27 08:39:43 +00:00
SegmentIntersection is ;
is . line = & out . segs [ i ] ;
is . expoly_with_offset = & poly_with_offset ;
is . iContour = iContour ;
2017-07-28 13:47:59 +00:00
is . iSegment = iSegment ;
2017-07-27 08:39:43 +00:00
// Test whether the calculated intersection point falls into the bounding box of the input segment.
// +-1 to take rounding into account.
2018-05-17 08:37:26 +00:00
assert ( int128 : : orient ( out . segs [ i ] . pos , out . segs [ i ] . pos + out . direction , * pl ) > = 0 ) ;
assert ( int128 : : orient ( out . segs [ i ] . pos , out . segs [ i ] . pos + out . direction , * pr ) < = 0 ) ;
2018-08-17 13:53:43 +00:00
assert ( is . pos ( ) ( 0 ) + 1 > = std : : min ( ( * pl ) ( 0 ) , ( * pr ) ( 0 ) ) ) ;
assert ( is . pos ( ) ( 1 ) + 1 > = std : : min ( ( * pl ) ( 1 ) , ( * pr ) ( 1 ) ) ) ;
assert ( is . pos ( ) ( 0 ) < = std : : max ( ( * pl ) ( 0 ) , ( * pr ) ( 0 ) ) + 1 ) ;
assert ( is . pos ( ) ( 1 ) < = std : : max ( ( * pl ) ( 1 ) , ( * pr ) ( 1 ) ) + 1 ) ;
2017-07-27 08:39:43 +00:00
out . segs [ i ] . intersections . push_back ( is ) ;
}
}
}
// Sort the intersections along their segments, specify the intersection types.
for ( size_t i_seg = 0 ; i_seg < out . segs . size ( ) ; + + i_seg ) {
SegmentedIntersectionLine & sil = out . segs [ i_seg ] ;
// Sort the intersection points using exact rational arithmetic.
std : : sort ( sil . intersections . begin ( ) , sil . intersections . end ( ) ) ;
2017-07-28 13:47:59 +00:00
# ifdef _DEBUG
// Verify that the intersections are sorted along the haching direction.
for ( size_t i = 1 ; i < sil . intersections . size ( ) ; + + i ) {
Point p1 = sil . intersections [ i - 1 ] . pos ( ) ;
Point p2 = sil . intersections [ i ] . pos ( ) ;
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
int64_t d = sil . dir . cast < int64_t > ( ) . dot ( ( p2 - p1 ) . cast < int64_t > ( ) ) ;
2017-07-28 13:47:59 +00:00
assert ( d > = - int64_t ( SCALED_EPSILON ) ) ;
}
# endif /* _DEBUG */
2017-07-27 08:39:43 +00:00
// Assign the intersection types, remove duplicate or overlapping intersection points.
// When a loop vertex touches a vertical line, intersection point is generated for both segments.
// If such two segments are oriented equally, then one of them is removed.
// Otherwise the vertex is tangential to the vertical line and both segments are removed.
// The same rule applies, if the loop is pinched into a single point and this point touches the vertical line:
// The loop has a zero vertical size at the vertical line, therefore the intersection point is removed.
size_t j = 0 ;
for ( size_t i = 0 ; i < sil . intersections . size ( ) ; + + i ) {
// What is the orientation of the segment at the intersection point?
size_t iContour = sil . intersections [ i ] . iContour ;
const Points & contour = poly_with_offset . contour ( iContour ) . points ;
size_t iSegment = sil . intersections [ i ] . iSegment ;
size_t iPrev = ( ( iSegment = = 0 ) ? contour . size ( ) : iSegment ) - 1 ;
2018-05-17 08:37:26 +00:00
int dir = int128 : : cross ( contour [ iSegment ] - contour [ iPrev ] , sil . dir ) ;
2017-07-27 08:39:43 +00:00
bool low = dir > 0 ;
sil . intersections [ i ] . type = poly_with_offset . is_contour_outer ( iContour ) ?
( low ? SegmentIntersection : : OUTER_LOW : SegmentIntersection : : OUTER_HIGH ) :
( low ? SegmentIntersection : : INNER_LOW : SegmentIntersection : : INNER_HIGH ) ;
if ( j > 0 & & sil . intersections [ i ] . iContour = = sil . intersections [ j - 1 ] . iContour ) {
// Two successive intersection points on a vertical line with the same contour. This may be a special case.
if ( sil . intersections [ i ] = = sil . intersections [ j - 1 ] ) {
// Two successive segments meet exactly at the vertical line.
# ifdef SLIC3R_DEBUG
// Verify that the segments of sil.intersections[i] and sil.intersections[j-1] are adjoint.
size_t iSegment2 = sil . intersections [ j - 1 ] . iSegment ;
size_t iPrev2 = ( ( iSegment2 = = 0 ) ? contour . size ( ) : iSegment2 ) - 1 ;
2017-07-28 13:47:59 +00:00
assert ( iSegment = = iPrev2 | | iSegment2 = = iPrev ) ;
2017-07-27 08:39:43 +00:00
# endif /* SLIC3R_DEBUG */
if ( sil . intersections [ i ] . type = = sil . intersections [ j - 1 ] . type ) {
// Two successive segments of the same direction (both to the right or both to the left)
// meet exactly at the vertical line.
// Remove the second intersection point.
} else {
// This is a loop returning to the same point.
// It may as well be a vertex of a loop touching this vertical line.
// Remove both the lines.
- - j ;
}
} else if ( sil . intersections [ i ] . type = = sil . intersections [ j - 1 ] . type ) {
// Two non successive segments of the same direction (both to the right or both to the left)
// meet exactly at the vertical line. That means there is a Z shaped path, where the center segment
// of the Z shaped path is aligned with this vertical line.
// Remove one of the intersection points while maximizing the vertical segment length.
if ( low ) {
// Remove the second intersection point, keep the first intersection point.
} else {
// Remove the first intersection point, keep the second intersection point.
sil . intersections [ j - 1 ] = sil . intersections [ i ] ;
}
} else {
// Vertical line intersects a contour segment at a general position (not at one of its end points).
// or the contour just touches this vertical line with a vertical segment or a sequence of vertical segments.
// Keep both intersection points.
if ( j < i )
sil . intersections [ j ] = sil . intersections [ i ] ;
+ + j ;
}
} else {
// Vertical line intersects a contour segment at a general position (not at one of its end points).
if ( j < i )
sil . intersections [ j ] = sil . intersections [ i ] ;
+ + j ;
}
}
// Shrink the list of intersections, if any of the intersection was removed during the classification.
if ( j < sil . intersections . size ( ) )
sil . intersections . erase ( sil . intersections . begin ( ) + j , sil . intersections . end ( ) ) ;
}
// Verify the segments. If something is wrong, give up.
# define ASSERT_OR_RETURN(CONDITION) do { assert(CONDITION); if (! (CONDITION)) return false; } while (0)
# ifdef _MSC_VER
# pragma warning(push)
# pragma warning(disable: 4127)
# endif
for ( size_t i_seg = 0 ; i_seg < out . segs . size ( ) ; + + i_seg ) {
SegmentedIntersectionLine & sil = out . segs [ i_seg ] ;
// The intersection points have to be even.
ASSERT_OR_RETURN ( ( sil . intersections . size ( ) & 1 ) = = 0 ) ;
for ( size_t i = 0 ; i < sil . intersections . size ( ) ; ) {
// An intersection segment crossing the bigger contour may cross the inner offsetted contour even number of times.
ASSERT_OR_RETURN ( sil . intersections [ i ] . type = = SegmentIntersection : : OUTER_LOW ) ;
size_t j = i + 1 ;
ASSERT_OR_RETURN ( j < sil . intersections . size ( ) ) ;
ASSERT_OR_RETURN ( sil . intersections [ j ] . type = = SegmentIntersection : : INNER_LOW | | sil . intersections [ j ] . type = = SegmentIntersection : : OUTER_HIGH ) ;
for ( ; j < sil . intersections . size ( ) & & sil . intersections [ j ] . is_inner ( ) ; + + j ) ;
ASSERT_OR_RETURN ( j < sil . intersections . size ( ) ) ;
ASSERT_OR_RETURN ( ( j & 1 ) = = 1 ) ;
ASSERT_OR_RETURN ( sil . intersections [ j ] . type = = SegmentIntersection : : OUTER_HIGH ) ;
ASSERT_OR_RETURN ( i + 1 = = j | | sil . intersections [ j - 1 ] . type = = SegmentIntersection : : INNER_HIGH ) ;
i = j + 1 ;
}
}
# undef ASSERT_OR_RETURN
# ifdef _MSC_VER
# pragma warning(push)
2017-08-18 19:09:53 +00:00
# endif /* _MSC_VER */
2017-07-27 08:39:43 +00:00
# ifdef SLIC3R_DEBUG
// Paint the segments and finalize the SVG file.
for ( size_t i_seg = 0 ; i_seg < out . segs . size ( ) ; + + i_seg ) {
SegmentedIntersectionLine & sil = out . segs [ i_seg ] ;
for ( size_t i = 0 ; i < sil . intersections . size ( ) ; ) {
size_t j = i + 1 ;
for ( ; j < sil . intersections . size ( ) & & sil . intersections [ j ] . is_inner ( ) ; + + j ) ;
if ( i + 1 = = j ) {
svg . draw ( Line ( sil . intersections [ i ] . pos ( ) , sil . intersections [ j ] . pos ( ) ) , " blue " ) ;
} else {
svg . draw ( Line ( sil . intersections [ i ] . pos ( ) , sil . intersections [ i + 1 ] . pos ( ) ) , " green " ) ;
svg . draw ( Line ( sil . intersections [ i + 1 ] . pos ( ) , sil . intersections [ j - 1 ] . pos ( ) ) , ( j - i + 1 > 4 ) ? " yellow " : " magenta " ) ;
svg . draw ( Line ( sil . intersections [ j - 1 ] . pos ( ) , sil . intersections [ j ] . pos ( ) ) , " green " ) ;
}
i = j + 1 ;
}
}
svg . Close ( ) ;
# endif /* SLIC3R_DEBUG */
return true ;
}
/****************************************************************** Legacy code, to be replaced by a graph algorithm ******************************************************************/
// Having a segment of a closed polygon, calculate its Euclidian length.
// The segment indices seg1 and seg2 signify an end point of an edge in the forward direction of the loop,
// therefore the point p1 lies on poly.points[seg1-1], poly.points[seg1] etc.
static inline coordf_t segment_length ( const Polygon & poly , size_t seg1 , const Point & p1 , size_t seg2 , const Point & p2 )
{
# ifdef SLIC3R_DEBUG
// Verify that p1 lies on seg1. This is difficult to verify precisely,
// but at least verify, that p1 lies in the bounding box of seg1.
for ( size_t i = 0 ; i < 2 ; + + i ) {
size_t seg = ( i = = 0 ) ? seg1 : seg2 ;
Point px = ( i = = 0 ) ? p1 : p2 ;
Point pa = poly . points [ ( ( seg = = 0 ) ? poly . points . size ( ) : seg ) - 1 ] ;
Point pb = poly . points [ seg ] ;
2018-08-17 13:53:43 +00:00
if ( pa ( 0 ) > pb ( 0 ) )
std : : swap ( pa ( 0 ) , pb ( 0 ) ) ;
if ( pa ( 1 ) > pb ( 1 ) )
std : : swap ( pa ( 1 ) , pb ( 1 ) ) ;
assert ( px ( 0 ) > = pa ( 0 ) & & px ( 0 ) < = pb ( 0 ) ) ;
assert ( px ( 1 ) > = pa ( 1 ) & & px ( 1 ) < = pb ( 1 ) ) ;
2017-07-27 08:39:43 +00:00
}
# endif /* SLIC3R_DEBUG */
const Point * pPrev = & p1 ;
const Point * pThis = NULL ;
coordf_t len = 0 ;
if ( seg1 < = seg2 ) {
for ( size_t i = seg1 ; i < seg2 ; + + i , pPrev = pThis )
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
len + = ( * pPrev - * ( pThis = & poly . points [ i ] ) ) . cast < double > ( ) . norm ( ) ;
2017-07-27 08:39:43 +00:00
} else {
for ( size_t i = seg1 ; i < poly . points . size ( ) ; + + i , pPrev = pThis )
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
len + = ( * pPrev - * ( pThis = & poly . points [ i ] ) ) . cast < double > ( ) . norm ( ) ;
2017-07-27 08:39:43 +00:00
for ( size_t i = 0 ; i < seg2 ; + + i , pPrev = pThis )
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
len + = ( * pPrev - * ( pThis = & poly . points [ i ] ) ) . cast < double > ( ) . norm ( ) ;
2017-07-27 08:39:43 +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
len + = ( * pPrev - p2 ) . cast < double > ( ) . norm ( ) ;
2017-07-27 08:39:43 +00:00
return len ;
}
// Append a segment of a closed polygon to a polyline.
// The segment indices seg1 and seg2 signify an end point of an edge in the forward direction of the loop.
// Only insert intermediate points between seg1 and seg2.
static inline void polygon_segment_append ( Points & out , const Polygon & polygon , size_t seg1 , size_t seg2 )
{
if ( seg1 = = seg2 ) {
// Nothing to append from this segment.
} else if ( seg1 < seg2 ) {
// Do not append a point pointed to by seg2.
out . insert ( out . end ( ) , polygon . points . begin ( ) + seg1 , polygon . points . begin ( ) + seg2 ) ;
} else {
out . reserve ( out . size ( ) + seg2 + polygon . points . size ( ) - seg1 ) ;
out . insert ( out . end ( ) , polygon . points . begin ( ) + seg1 , polygon . points . end ( ) ) ;
// Do not append a point pointed to by seg2.
out . insert ( out . end ( ) , polygon . points . begin ( ) , polygon . points . begin ( ) + seg2 ) ;
}
}
// Append a segment of a closed polygon to a polyline.
// The segment indices seg1 and seg2 signify an end point of an edge in the forward direction of the loop,
// but this time the segment is traversed backward.
// Only insert intermediate points between seg1 and seg2.
static inline void polygon_segment_append_reversed ( Points & out , const Polygon & polygon , size_t seg1 , size_t seg2 )
{
if ( seg1 > = seg2 ) {
out . reserve ( seg1 - seg2 ) ;
for ( size_t i = seg1 ; i > seg2 ; - - i )
out . push_back ( polygon . points [ i - 1 ] ) ;
} else {
// it could be, that seg1 == seg2. In that case, append the complete loop.
out . reserve ( out . size ( ) + seg2 + polygon . points . size ( ) - seg1 ) ;
for ( size_t i = seg1 ; i > 0 ; - - i )
out . push_back ( polygon . points [ i - 1 ] ) ;
for ( size_t i = polygon . points . size ( ) ; i > seg2 ; - - i )
out . push_back ( polygon . points [ i - 1 ] ) ;
}
}
static inline int distance_of_segmens ( const Polygon & poly , size_t seg1 , size_t seg2 , bool forward )
{
int d = int ( seg2 ) - int ( seg1 ) ;
if ( ! forward )
d = - d ;
if ( d < 0 )
d + = int ( poly . points . size ( ) ) ;
return d ;
}
// For a vertical line, an inner contour and an intersection point,
// find an intersection point on the previous resp. next vertical line.
// The intersection point is connected with the prev resp. next intersection point with iInnerContour.
// Return -1 if there is no such point on the previous resp. next vertical line.
static inline int intersection_on_prev_next_vertical_line (
const ExPolygonWithOffset & poly_with_offset ,
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t iVerticalLine ,
size_t iInnerContour ,
size_t iIntersection ,
bool dir_is_next )
{
size_t iVerticalLineOther = iVerticalLine ;
if ( dir_is_next ) {
if ( + + iVerticalLineOther = = segs . size ( ) )
// No successive vertical line.
return - 1 ;
} else if ( iVerticalLineOther - - = = 0 ) {
// No preceding vertical line.
return - 1 ;
}
const SegmentedIntersectionLine & il = segs [ iVerticalLine ] ;
const SegmentIntersection & itsct = il . intersections [ iIntersection ] ;
const SegmentedIntersectionLine & il2 = segs [ iVerticalLineOther ] ;
const Polygon & poly = poly_with_offset . contour ( iInnerContour ) ;
// const bool ccw = poly_with_offset.is_contour_ccw(iInnerContour);
const bool forward = itsct . is_low ( ) = = dir_is_next ;
// Resulting index of an intersection point on il2.
int out = - 1 ;
// Find an intersection point on iVerticalLineOther, intersecting iInnerContour
// at the same orientation as iIntersection, and being closest to iIntersection
// in the number of contour segments, when following the direction of the contour.
int dmin = std : : numeric_limits < int > : : max ( ) ;
for ( size_t i = 0 ; i < il2 . intersections . size ( ) ; + + i ) {
const SegmentIntersection & itsct2 = il2 . intersections [ i ] ;
if ( itsct . iContour = = itsct2 . iContour & & itsct . type = = itsct2 . type ) {
/*
if ( itsct . is_low ( ) ) {
2017-07-28 13:47:59 +00:00
assert ( itsct . type = = SegmentIntersection : : INNER_LOW ) ;
assert ( iIntersection > 0 ) ;
assert ( il . intersections [ iIntersection - 1 ] . type = = SegmentIntersection : : OUTER_LOW ) ;
assert ( i > 0 ) ;
2017-07-27 08:39:43 +00:00
if ( il2 . intersections [ i - 1 ] . is_inner ( ) )
// Take only the lowest inner intersection point.
continue ;
2017-07-28 13:47:59 +00:00
assert ( il2 . intersections [ i - 1 ] . type = = SegmentIntersection : : OUTER_LOW ) ;
2017-07-27 08:39:43 +00:00
} else {
2017-07-28 13:47:59 +00:00
assert ( itsct . type = = SegmentIntersection : : INNER_HIGH ) ;
assert ( iIntersection + 1 < il . intersections . size ( ) ) ;
assert ( il . intersections [ iIntersection + 1 ] . type = = SegmentIntersection : : OUTER_HIGH ) ;
assert ( i + 1 < il2 . intersections . size ( ) ) ;
2017-07-27 08:39:43 +00:00
if ( il2 . intersections [ i + 1 ] . is_inner ( ) )
// Take only the highest inner intersection point.
continue ;
2017-07-28 13:47:59 +00:00
assert ( il2 . intersections [ i + 1 ] . type = = SegmentIntersection : : OUTER_HIGH ) ;
2017-07-27 08:39:43 +00:00
}
*/
// The intersection points lie on the same contour and have the same orientation.
// Find the intersection point with a shortest path in the direction of the contour.
int d = distance_of_segmens ( poly , itsct . iSegment , itsct2 . iSegment , forward ) ;
if ( d < dmin ) {
out = i ;
dmin = d ;
}
}
}
//FIXME this routine is not asymptotic optimal, it will be slow if there are many intersection points along the line.
return out ;
}
static inline int intersection_on_prev_vertical_line (
const ExPolygonWithOffset & poly_with_offset ,
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t iVerticalLine ,
size_t iInnerContour ,
size_t iIntersection )
{
return intersection_on_prev_next_vertical_line ( poly_with_offset , segs , iVerticalLine , iInnerContour , iIntersection , false ) ;
}
static inline int intersection_on_next_vertical_line (
const ExPolygonWithOffset & poly_with_offset ,
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t iVerticalLine ,
size_t iInnerContour ,
size_t iIntersection )
{
return intersection_on_prev_next_vertical_line ( poly_with_offset , segs , iVerticalLine , iInnerContour , iIntersection , true ) ;
}
enum IntersectionTypeOtherVLine {
// There is no connection point on the other vertical line.
INTERSECTION_TYPE_OTHER_VLINE_UNDEFINED = - 1 ,
// Connection point on the other vertical segment was found
// and it could be followed.
INTERSECTION_TYPE_OTHER_VLINE_OK = 0 ,
// The connection segment connects to a middle of a vertical segment.
// Cannot follow.
INTERSECTION_TYPE_OTHER_VLINE_INNER ,
// Cannot extend the contor to this intersection point as either the connection segment
// or the succeeding vertical segment were already consumed.
INTERSECTION_TYPE_OTHER_VLINE_CONSUMED ,
// Not the first intersection along the contor. This intersection point
// has been preceded by an intersection point along the vertical line.
INTERSECTION_TYPE_OTHER_VLINE_NOT_FIRST ,
} ;
// Find an intersection on a previous line, but return -1, if the connecting segment of a perimeter was already extruded.
static inline IntersectionTypeOtherVLine intersection_type_on_prev_next_vertical_line (
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t iVerticalLine ,
size_t iIntersection ,
size_t iIntersectionOther ,
bool dir_is_next )
{
// This routine will propose a connecting line even if the connecting perimeter segment intersects
// iVertical line multiple times before reaching iIntersectionOther.
2019-06-25 11:06:04 +00:00
if ( iIntersectionOther = = size_t ( - 1 ) )
2017-07-27 08:39:43 +00:00
return INTERSECTION_TYPE_OTHER_VLINE_UNDEFINED ;
2017-07-28 13:47:59 +00:00
assert ( dir_is_next ? ( iVerticalLine + 1 < segs . size ( ) ) : ( iVerticalLine > 0 ) ) ;
2017-07-27 08:39:43 +00:00
const SegmentedIntersectionLine & il_this = segs [ iVerticalLine ] ;
const SegmentIntersection & itsct_this = il_this . intersections [ iIntersection ] ;
const SegmentedIntersectionLine & il_other = segs [ dir_is_next ? ( iVerticalLine + 1 ) : ( iVerticalLine - 1 ) ] ;
const SegmentIntersection & itsct_other = il_other . intersections [ iIntersectionOther ] ;
2017-07-28 13:47:59 +00:00
assert ( itsct_other . is_inner ( ) ) ;
assert ( iIntersectionOther > 0 ) ;
assert ( iIntersectionOther + 1 < il_other . intersections . size ( ) ) ;
2017-07-27 08:39:43 +00:00
// Is iIntersectionOther at the boundary of a vertical segment?
const SegmentIntersection & itsct_other2 = il_other . intersections [ itsct_other . is_low ( ) ? iIntersectionOther - 1 : iIntersectionOther + 1 ] ;
if ( itsct_other2 . is_inner ( ) )
// Cannot follow a perimeter segment into the middle of another vertical segment.
// Only perimeter segments connecting to the end of a vertical segment are followed.
return INTERSECTION_TYPE_OTHER_VLINE_INNER ;
2017-07-28 13:47:59 +00:00
assert ( itsct_other . is_low ( ) = = itsct_other2 . is_low ( ) ) ;
2017-07-27 08:39:43 +00:00
if ( dir_is_next ? itsct_this . consumed_perimeter_right : itsct_other . consumed_perimeter_right )
// This perimeter segment was already consumed.
return INTERSECTION_TYPE_OTHER_VLINE_CONSUMED ;
if ( itsct_other . is_low ( ) ? itsct_other . consumed_vertical_up : il_other . intersections [ iIntersectionOther - 1 ] . consumed_vertical_up )
// This vertical segment was already consumed.
return INTERSECTION_TYPE_OTHER_VLINE_CONSUMED ;
return INTERSECTION_TYPE_OTHER_VLINE_OK ;
}
static inline IntersectionTypeOtherVLine intersection_type_on_prev_vertical_line (
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t iVerticalLine ,
size_t iIntersection ,
size_t iIntersectionPrev )
{
return intersection_type_on_prev_next_vertical_line ( segs , iVerticalLine , iIntersection , iIntersectionPrev , false ) ;
}
static inline IntersectionTypeOtherVLine intersection_type_on_next_vertical_line (
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t iVerticalLine ,
size_t iIntersection ,
size_t iIntersectionNext )
{
return intersection_type_on_prev_next_vertical_line ( segs , iVerticalLine , iIntersection , iIntersectionNext , true ) ;
}
// Measure an Euclidian length of a perimeter segment when going from iIntersection to iIntersection2.
static inline coordf_t measure_perimeter_prev_next_segment_length (
const ExPolygonWithOffset & poly_with_offset ,
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t iVerticalLine ,
size_t iInnerContour ,
size_t iIntersection ,
size_t iIntersection2 ,
bool dir_is_next )
{
size_t iVerticalLineOther = iVerticalLine ;
if ( dir_is_next ) {
if ( + + iVerticalLineOther = = segs . size ( ) )
// No successive vertical line.
return coordf_t ( - 1 ) ;
} else if ( iVerticalLineOther - - = = 0 ) {
// No preceding vertical line.
return coordf_t ( - 1 ) ;
}
const SegmentedIntersectionLine & il = segs [ iVerticalLine ] ;
const SegmentIntersection & itsct = il . intersections [ iIntersection ] ;
const SegmentedIntersectionLine & il2 = segs [ iVerticalLineOther ] ;
const SegmentIntersection & itsct2 = il2 . intersections [ iIntersection2 ] ;
const Polygon & poly = poly_with_offset . contour ( iInnerContour ) ;
// const bool ccw = poly_with_offset.is_contour_ccw(iInnerContour);
2017-07-28 13:47:59 +00:00
assert ( itsct . type = = itsct2 . type ) ;
assert ( itsct . iContour = = itsct2 . iContour ) ;
assert ( itsct . is_inner ( ) ) ;
2017-07-27 08:39:43 +00:00
const bool forward = itsct . is_low ( ) = = dir_is_next ;
Point p1 = itsct . pos ( ) ;
Point p2 = itsct2 . pos ( ) ;
return forward ?
segment_length ( poly , itsct . iSegment , p1 , itsct2 . iSegment , p2 ) :
segment_length ( poly , itsct2 . iSegment , p2 , itsct . iSegment , p1 ) ;
}
static inline coordf_t measure_perimeter_prev_segment_length (
const ExPolygonWithOffset & poly_with_offset ,
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t iVerticalLine ,
size_t iInnerContour ,
size_t iIntersection ,
size_t iIntersection2 )
{
return measure_perimeter_prev_next_segment_length ( poly_with_offset , segs , iVerticalLine , iInnerContour , iIntersection , iIntersection2 , false ) ;
}
static inline coordf_t measure_perimeter_next_segment_length (
const ExPolygonWithOffset & poly_with_offset ,
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t iVerticalLine ,
size_t iInnerContour ,
size_t iIntersection ,
size_t iIntersection2 )
{
return measure_perimeter_prev_next_segment_length ( poly_with_offset , segs , iVerticalLine , iInnerContour , iIntersection , iIntersection2 , true ) ;
}
// Append the points of a perimeter segment when going from iIntersection to iIntersection2.
// The first point (the point of iIntersection) will not be inserted,
// the last point will be inserted.
static inline void emit_perimeter_prev_next_segment (
const ExPolygonWithOffset & poly_with_offset ,
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t iVerticalLine ,
size_t iInnerContour ,
size_t iIntersection ,
size_t iIntersection2 ,
Polyline & out ,
bool dir_is_next )
{
size_t iVerticalLineOther = iVerticalLine ;
if ( dir_is_next ) {
+ + iVerticalLineOther ;
2017-07-28 13:47:59 +00:00
assert ( iVerticalLineOther < segs . size ( ) ) ;
2017-07-27 08:39:43 +00:00
} else {
2017-07-28 13:47:59 +00:00
assert ( iVerticalLineOther > 0 ) ;
2017-07-27 08:39:43 +00:00
- - iVerticalLineOther ;
}
const SegmentedIntersectionLine & il = segs [ iVerticalLine ] ;
const SegmentIntersection & itsct = il . intersections [ iIntersection ] ;
const SegmentedIntersectionLine & il2 = segs [ iVerticalLineOther ] ;
const SegmentIntersection & itsct2 = il2 . intersections [ iIntersection2 ] ;
const Polygon & poly = poly_with_offset . contour ( iInnerContour ) ;
// const bool ccw = poly_with_offset.is_contour_ccw(iInnerContour);
2017-07-28 13:47:59 +00:00
assert ( itsct . type = = itsct2 . type ) ;
assert ( itsct . iContour = = itsct2 . iContour ) ;
assert ( itsct . is_inner ( ) ) ;
2017-07-27 08:39:43 +00:00
const bool forward = itsct . is_low ( ) = = dir_is_next ;
// Do not append the first point.
// out.points.push_back(Point(il.pos, itsct.pos));
if ( forward )
polygon_segment_append ( out . points , poly , itsct . iSegment , itsct2 . iSegment ) ;
else
polygon_segment_append_reversed ( out . points , poly , itsct . iSegment , itsct2 . iSegment ) ;
// Append the last point.
out . points . push_back ( itsct2 . pos ( ) ) ;
}
static inline coordf_t measure_perimeter_segment_on_vertical_line_length (
const ExPolygonWithOffset & poly_with_offset ,
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t iVerticalLine ,
size_t iInnerContour ,
size_t iIntersection ,
size_t iIntersection2 ,
bool forward )
{
const SegmentedIntersectionLine & il = segs [ iVerticalLine ] ;
const SegmentIntersection & itsct = il . intersections [ iIntersection ] ;
const SegmentIntersection & itsct2 = il . intersections [ iIntersection2 ] ;
const Polygon & poly = poly_with_offset . contour ( iInnerContour ) ;
2017-07-28 13:47:59 +00:00
assert ( itsct . is_inner ( ) ) ;
assert ( itsct2 . is_inner ( ) ) ;
assert ( itsct . type ! = itsct2 . type ) ;
assert ( itsct . iContour = = iInnerContour ) ;
assert ( itsct . iContour = = itsct2 . iContour ) ;
2017-07-27 08:39:43 +00:00
return forward ?
segment_length ( poly , itsct . iSegment , itsct . pos ( ) , itsct2 . iSegment , itsct2 . pos ( ) ) :
segment_length ( poly , itsct2 . iSegment , itsct2 . pos ( ) , itsct . iSegment , itsct . pos ( ) ) ;
}
// Append the points of a perimeter segment when going from iIntersection to iIntersection2.
// The first point (the point of iIntersection) will not be inserted,
// the last point will be inserted.
static inline void emit_perimeter_segment_on_vertical_line (
const ExPolygonWithOffset & poly_with_offset ,
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t iVerticalLine ,
size_t iInnerContour ,
size_t iIntersection ,
size_t iIntersection2 ,
Polyline & out ,
bool forward )
{
const SegmentedIntersectionLine & il = segs [ iVerticalLine ] ;
const SegmentIntersection & itsct = il . intersections [ iIntersection ] ;
const SegmentIntersection & itsct2 = il . intersections [ iIntersection2 ] ;
const Polygon & poly = poly_with_offset . contour ( iInnerContour ) ;
2017-07-28 13:47:59 +00:00
assert ( itsct . is_inner ( ) ) ;
assert ( itsct2 . is_inner ( ) ) ;
assert ( itsct . type ! = itsct2 . type ) ;
assert ( itsct . iContour = = iInnerContour ) ;
assert ( itsct . iContour = = itsct2 . iContour ) ;
2017-07-27 08:39:43 +00:00
// Do not append the first point.
// out.points.push_back(Point(il.pos, itsct.pos));
if ( forward )
polygon_segment_append ( out . points , poly , itsct . iSegment , itsct2 . iSegment ) ;
else
polygon_segment_append_reversed ( out . points , poly , itsct . iSegment , itsct2 . iSegment ) ;
// Append the last point.
out . points . push_back ( itsct2 . pos ( ) ) ;
}
//TBD: For precise infill, measure the area of a slab spanned by an infill line.
/*
static inline float measure_outer_contour_slab (
const ExPolygonWithOffset & poly_with_offset ,
const std : : vector < SegmentedIntersectionLine > & segs ,
size_t i_vline ,
size_t iIntersection )
{
const SegmentedIntersectionLine & il = segs [ i_vline ] ;
const SegmentIntersection & itsct = il . intersections [ i_vline ] ;
const SegmentIntersection & itsct2 = il . intersections [ iIntersection2 ] ;
const Polygon & poly = poly_with_offset . contour ( ( itsct . iContour ) ;
2017-07-28 13:47:59 +00:00
assert ( itsct . is_outer ( ) ) ;
assert ( itsct2 . is_outer ( ) ) ;
assert ( itsct . type ! = itsct2 . type ) ;
assert ( itsct . iContour = = itsct2 . iContour ) ;
2017-07-27 08:39:43 +00:00
if ( ! itsct . is_outer ( ) | | ! itsct2 . is_outer ( ) | | itsct . type = = itsct2 . type | | itsct . iContour ! = itsct2 . iContour )
// Error, return zero area.
return 0.f ;
// Find possible connection points on the previous / next vertical line.
int iPrev = intersection_on_prev_vertical_line ( poly_with_offset , segs , i_vline , itsct . iContour , i_intersection ) ;
int iNext = intersection_on_next_vertical_line ( poly_with_offset , segs , i_vline , itsct . iContour , i_intersection ) ;
// Find possible connection points on the same vertical line.
int iAbove = iBelow = - 1 ;
// Does the perimeter intersect the current vertical line above intrsctn?
for ( size_t i = i_intersection + 1 ; i + 1 < seg . intersections . size ( ) ; + + i )
if ( seg . intersections [ i ] . iContour = = itsct . iContour )
{ iAbove = i ; break ; }
// Does the perimeter intersect the current vertical line below intrsctn?
for ( int i = int ( i_intersection ) - 1 ; i > 0 ; - - i )
if ( seg . intersections [ i ] . iContour = = itsct . iContour )
{ iBelow = i ; break ; }
if ( iSegAbove ! = - 1 & & seg . intersections [ iAbove ] . type = = SegmentIntersection : : OUTER_HIGH ) {
// Invalidate iPrev resp. iNext, if the perimeter crosses the current vertical line earlier than iPrev resp. iNext.
// The perimeter contour orientation.
const Polygon & poly = poly_with_offset . contour ( itsct . iContour ) ;
{
int d_horiz = ( iPrev = = - 1 ) ? std : : numeric_limits < int > : : max ( ) :
distance_of_segmens ( poly , segs [ i_vline - 1 ] . intersections [ iPrev ] . iSegment , itsct . iSegment , true ) ;
int d_down = ( iBelow = = - 1 ) ? std : : numeric_limits < int > : : max ( ) :
distance_of_segmens ( poly , iSegBelow , itsct . iSegment , true ) ;
int d_up = ( iAbove = = - 1 ) ? std : : numeric_limits < int > : : max ( ) :
distance_of_segmens ( poly , iSegAbove , itsct . iSegment , true ) ;
if ( intrsctn_type_prev = = INTERSECTION_TYPE_OTHER_VLINE_OK & & d_horiz > std : : min ( d_down , d_up ) )
// The vertical crossing comes eralier than the prev crossing.
// Disable the perimeter going back.
intrsctn_type_prev = INTERSECTION_TYPE_OTHER_VLINE_NOT_FIRST ;
if ( d_up > std : : min ( d_horiz , d_down ) )
// The horizontal crossing comes earlier than the vertical crossing.
vert_seg_dir_valid_mask & = ~ DIR_BACKWARD ;
}
{
int d_horiz = ( iNext = = - 1 ) ? std : : numeric_limits < int > : : max ( ) :
distance_of_segmens ( poly , itsct . iSegment , segs [ i_vline + 1 ] . intersections [ iNext ] . iSegment , true ) ;
int d_down = ( iSegBelow = = - 1 ) ? std : : numeric_limits < int > : : max ( ) :
distance_of_segmens ( poly , itsct . iSegment , iSegBelow , true ) ;
int d_up = ( iSegAbove = = - 1 ) ? std : : numeric_limits < int > : : max ( ) :
distance_of_segmens ( poly , itsct . iSegment , iSegAbove , true ) ;
if ( d_up > std : : min ( d_horiz , d_down ) )
// The horizontal crossing comes earlier than the vertical crossing.
vert_seg_dir_valid_mask & = ~ DIR_FORWARD ;
}
}
}
*/
enum DirectionMask
{
DIR_FORWARD = 1 ,
DIR_BACKWARD = 2
} ;
// For the rectilinear, grid, triangles, stars and cubic pattern fill one InfillHatchingSingleDirection structure
// for each infill direction. The segments stored in InfillHatchingSingleDirection will then form a graph of candidate
// paths to be extruded.
static bool fill_hatching_segments_legacy (
// Input geometry to be hatch, containing two concentric contours for each input contour.
const ExPolygonWithOffset & poly_with_offset ,
// fill density, dont_adjust
const FillParams & params ,
const coord_t link_max_length ,
// Resulting straight segments of the infill graph.
InfillHatchingSingleDirection & hatching ,
Polylines & polylines_out )
{
// At the end, only the new polylines will be rotated back.
size_t n_polylines_out_initial = polylines_out . size ( ) ;
std : : vector < SegmentedIntersectionLine > & segs = hatching . segs ;
// For each outer only chords, measure their maximum distance to the bow of the outer contour.
// Mark an outer only chord as consumed, if the distance is low.
for ( size_t i_vline = 0 ; i_vline < segs . size ( ) ; + + i_vline ) {
SegmentedIntersectionLine & seg = segs [ i_vline ] ;
for ( size_t i_intersection = 0 ; i_intersection + 1 < seg . intersections . size ( ) ; + + i_intersection ) {
if ( seg . intersections [ i_intersection ] . type = = SegmentIntersection : : OUTER_LOW & &
seg . intersections [ i_intersection + 1 ] . type = = SegmentIntersection : : OUTER_HIGH ) {
bool consumed = false ;
// if (params.full_infill()) {
// measure_outer_contour_slab(poly_with_offset, segs, i_vline, i_ntersection);
// } else
consumed = true ;
seg . intersections [ i_intersection ] . consumed_vertical_up = consumed ;
}
}
}
// Now construct a graph.
// Find the first point.
// Naively one would expect to achieve best results by chaining the paths by the shortest distance,
// but that procedure does not create the longest continuous paths.
// A simple "sweep left to right" procedure achieves better results.
size_t i_vline = 0 ;
size_t i_intersection = size_t ( - 1 ) ;
// Follow the line, connect the lines into a graph.
// Until no new line could be added to the output path:
Point pointLast ;
Polyline * polyline_current = NULL ;
if ( ! polylines_out . empty ( ) )
pointLast = polylines_out . back ( ) . points . back ( ) ;
for ( ; ; ) {
if ( i_intersection = = size_t ( - 1 ) ) {
// The path has been interrupted. Find a next starting point, closest to the previous extruder position.
coordf_t dist2min = std : : numeric_limits < coordf_t > ( ) . max ( ) ;
for ( size_t i_vline2 = 0 ; i_vline2 < segs . size ( ) ; + + i_vline2 ) {
const SegmentedIntersectionLine & seg = segs [ i_vline2 ] ;
if ( ! seg . intersections . empty ( ) ) {
2017-07-28 13:47:59 +00:00
assert ( seg . intersections . size ( ) > 1 ) ;
2017-07-27 08:39:43 +00:00
// Even number of intersections with the loops.
2017-07-28 13:47:59 +00:00
assert ( ( seg . intersections . size ( ) & 1 ) = = 0 ) ;
assert ( seg . intersections . front ( ) . type = = SegmentIntersection : : OUTER_LOW ) ;
2017-07-27 08:39:43 +00:00
for ( size_t i = 0 ; i < seg . intersections . size ( ) ; + + i ) {
const SegmentIntersection & intrsctn = seg . intersections [ i ] ;
if ( intrsctn . is_outer ( ) ) {
2017-07-28 13:47:59 +00:00
assert ( intrsctn . is_low ( ) | | i > 0 ) ;
2017-07-27 08:39:43 +00:00
bool consumed = intrsctn . is_low ( ) ?
intrsctn . consumed_vertical_up :
seg . intersections [ i - 1 ] . consumed_vertical_up ;
if ( ! consumed ) {
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
coordf_t dist2 = ( intrsctn . pos ( ) - pointLast ) . cast < double > ( ) . norm ( ) ;
2017-07-27 08:39:43 +00:00
if ( dist2 < dist2min ) {
dist2min = dist2 ;
i_vline = i_vline2 ;
i_intersection = i ;
//FIXME We are taking the first left point always. Verify, that the caller chains the paths
// by a shortest distance, while reversing the paths if needed.
//if (polylines_out.empty())
// Initial state, take the first line, which is the first from the left.
goto found ;
}
}
}
}
}
}
if ( i_intersection = = size_t ( - 1 ) )
// We are finished.
break ;
found :
// Start a new path.
polylines_out . push_back ( Polyline ( ) ) ;
polyline_current = & polylines_out . back ( ) ;
// Emit the first point of a path.
pointLast = segs [ i_vline ] . intersections [ i_intersection ] . pos ( ) ;
polyline_current - > points . push_back ( pointLast ) ;
}
// From the initial point (i_vline, i_intersection), follow a path.
SegmentedIntersectionLine & seg = segs [ i_vline ] ;
SegmentIntersection * intrsctn = & seg . intersections [ i_intersection ] ;
bool going_up = intrsctn - > is_low ( ) ;
bool try_connect = false ;
if ( going_up ) {
2017-07-28 13:47:59 +00:00
assert ( ! intrsctn - > consumed_vertical_up ) ;
assert ( i_intersection + 1 < seg . intersections . size ( ) ) ;
2017-07-27 08:39:43 +00:00
// Step back to the beginning of the vertical segment to mark it as consumed.
if ( intrsctn - > is_inner ( ) ) {
2017-07-28 13:47:59 +00:00
assert ( i_intersection > 0 ) ;
2017-07-27 08:39:43 +00:00
- - intrsctn ;
- - i_intersection ;
}
// Consume the complete vertical segment up to the outer contour.
do {
intrsctn - > consumed_vertical_up = true ;
+ + intrsctn ;
+ + i_intersection ;
2017-07-28 13:47:59 +00:00
assert ( i_intersection < seg . intersections . size ( ) ) ;
2017-07-27 08:39:43 +00:00
} while ( intrsctn - > type ! = SegmentIntersection : : OUTER_HIGH ) ;
if ( ( intrsctn - 1 ) - > is_inner ( ) ) {
// Step back.
- - intrsctn ;
- - i_intersection ;
2017-07-28 13:47:59 +00:00
assert ( intrsctn - > type = = SegmentIntersection : : INNER_HIGH ) ;
2017-07-27 08:39:43 +00:00
try_connect = true ;
}
} else {
// Going down.
2017-07-28 13:47:59 +00:00
assert ( intrsctn - > is_high ( ) ) ;
assert ( i_intersection > 0 ) ;
assert ( ! ( intrsctn - 1 ) - > consumed_vertical_up ) ;
2017-07-27 08:39:43 +00:00
// Consume the complete vertical segment up to the outer contour.
if ( intrsctn - > is_inner ( ) )
intrsctn - > consumed_vertical_up = true ;
do {
2017-07-28 13:47:59 +00:00
assert ( i_intersection > 0 ) ;
2017-07-27 08:39:43 +00:00
- - intrsctn ;
- - i_intersection ;
intrsctn - > consumed_vertical_up = true ;
} while ( intrsctn - > type ! = SegmentIntersection : : OUTER_LOW ) ;
if ( ( intrsctn + 1 ) - > is_inner ( ) ) {
// Step back.
+ + intrsctn ;
+ + i_intersection ;
2017-07-28 13:47:59 +00:00
assert ( intrsctn - > type = = SegmentIntersection : : INNER_LOW ) ;
2017-07-27 08:39:43 +00:00
try_connect = true ;
}
}
if ( try_connect ) {
// Decide, whether to finish the segment, or whether to follow the perimeter.
// 1) Find possible connection points on the previous / next vertical line.
int iPrev = intersection_on_prev_vertical_line ( poly_with_offset , segs , i_vline , intrsctn - > iContour , i_intersection ) ;
int iNext = intersection_on_next_vertical_line ( poly_with_offset , segs , i_vline , intrsctn - > iContour , i_intersection ) ;
IntersectionTypeOtherVLine intrsctn_type_prev = intersection_type_on_prev_vertical_line ( segs , i_vline , i_intersection , iPrev ) ;
IntersectionTypeOtherVLine intrsctn_type_next = intersection_type_on_next_vertical_line ( segs , i_vline , i_intersection , iNext ) ;
// 2) Find possible connection points on the same vertical line.
int iAbove = - 1 ;
int iBelow = - 1 ;
int iSegAbove = - 1 ;
int iSegBelow = - 1 ;
{
2019-06-25 11:06:04 +00:00
// SegmentIntersection::SegmentIntersectionType type_crossing = (intrsctn->type == SegmentIntersection::INNER_LOW) ?
// SegmentIntersection::INNER_HIGH : SegmentIntersection::INNER_LOW;
2017-07-27 08:39:43 +00:00
// Does the perimeter intersect the current vertical line above intrsctn?
for ( size_t i = i_intersection + 1 ; i + 1 < seg . intersections . size ( ) ; + + i )
// if (seg.intersections[i].iContour == intrsctn->iContour && seg.intersections[i].type == type_crossing) {
if ( seg . intersections [ i ] . iContour = = intrsctn - > iContour ) {
iAbove = i ;
iSegAbove = seg . intersections [ i ] . iSegment ;
break ;
}
// Does the perimeter intersect the current vertical line below intrsctn?
for ( size_t i = i_intersection - 1 ; i > 0 ; - - i )
// if (seg.intersections[i].iContour == intrsctn->iContour && seg.intersections[i].type == type_crossing) {
if ( seg . intersections [ i ] . iContour = = intrsctn - > iContour ) {
iBelow = i ;
iSegBelow = seg . intersections [ i ] . iSegment ;
break ;
}
}
// 3) Sort the intersection points, clear iPrev / iNext / iSegBelow / iSegAbove,
// if it is preceded by any other intersection point along the contour.
unsigned int vert_seg_dir_valid_mask =
( going_up ?
( iSegAbove ! = - 1 & & seg . intersections [ iAbove ] . type = = SegmentIntersection : : INNER_LOW ) :
( iSegBelow ! = - 1 & & seg . intersections [ iBelow ] . type = = SegmentIntersection : : INNER_HIGH ) ) ?
( DIR_FORWARD | DIR_BACKWARD ) :
0 ;
{
// Invalidate iPrev resp. iNext, if the perimeter crosses the current vertical line earlier than iPrev resp. iNext.
// The perimeter contour orientation.
const bool forward = intrsctn - > is_low ( ) ; // == poly_with_offset.is_contour_ccw(intrsctn->iContour);
const Polygon & poly = poly_with_offset . contour ( intrsctn - > iContour ) ;
{
int d_horiz = ( iPrev = = - 1 ) ? std : : numeric_limits < int > : : max ( ) :
distance_of_segmens ( poly , segs [ i_vline - 1 ] . intersections [ iPrev ] . iSegment , intrsctn - > iSegment , forward ) ;
int d_down = ( iSegBelow = = - 1 ) ? std : : numeric_limits < int > : : max ( ) :
distance_of_segmens ( poly , iSegBelow , intrsctn - > iSegment , forward ) ;
int d_up = ( iSegAbove = = - 1 ) ? std : : numeric_limits < int > : : max ( ) :
distance_of_segmens ( poly , iSegAbove , intrsctn - > iSegment , forward ) ;
if ( intrsctn_type_prev = = INTERSECTION_TYPE_OTHER_VLINE_OK & & d_horiz > std : : min ( d_down , d_up ) )
// The vertical crossing comes eralier than the prev crossing.
// Disable the perimeter going back.
intrsctn_type_prev = INTERSECTION_TYPE_OTHER_VLINE_NOT_FIRST ;
if ( going_up ? ( d_up > std : : min ( d_horiz , d_down ) ) : ( d_down > std : : min ( d_horiz , d_up ) ) )
// The horizontal crossing comes earlier than the vertical crossing.
vert_seg_dir_valid_mask & = ~ ( forward ? DIR_BACKWARD : DIR_FORWARD ) ;
}
{
int d_horiz = ( iNext = = - 1 ) ? std : : numeric_limits < int > : : max ( ) :
distance_of_segmens ( poly , intrsctn - > iSegment , segs [ i_vline + 1 ] . intersections [ iNext ] . iSegment , forward ) ;
int d_down = ( iSegBelow = = - 1 ) ? std : : numeric_limits < int > : : max ( ) :
distance_of_segmens ( poly , intrsctn - > iSegment , iSegBelow , forward ) ;
int d_up = ( iSegAbove = = - 1 ) ? std : : numeric_limits < int > : : max ( ) :
distance_of_segmens ( poly , intrsctn - > iSegment , iSegAbove , forward ) ;
if ( intrsctn_type_next = = INTERSECTION_TYPE_OTHER_VLINE_OK & & d_horiz > std : : min ( d_down , d_up ) )
// The vertical crossing comes eralier than the prev crossing.
// Disable the perimeter going forward.
intrsctn_type_next = INTERSECTION_TYPE_OTHER_VLINE_NOT_FIRST ;
if ( going_up ? ( d_up > std : : min ( d_horiz , d_down ) ) : ( d_down > std : : min ( d_horiz , d_up ) ) )
// The horizontal crossing comes earlier than the vertical crossing.
vert_seg_dir_valid_mask & = ~ ( forward ? DIR_FORWARD : DIR_BACKWARD ) ;
}
}
// 4) Try to connect to a previous or next vertical line, making a zig-zag pattern.
if ( intrsctn_type_prev = = INTERSECTION_TYPE_OTHER_VLINE_OK | | intrsctn_type_next = = INTERSECTION_TYPE_OTHER_VLINE_OK ) {
coordf_t distPrev = ( intrsctn_type_prev ! = INTERSECTION_TYPE_OTHER_VLINE_OK ) ? std : : numeric_limits < coord_t > : : max ( ) :
measure_perimeter_prev_segment_length ( poly_with_offset , segs , i_vline , intrsctn - > iContour , i_intersection , iPrev ) ;
coordf_t distNext = ( intrsctn_type_next ! = INTERSECTION_TYPE_OTHER_VLINE_OK ) ? std : : numeric_limits < coord_t > : : max ( ) :
measure_perimeter_next_segment_length ( poly_with_offset , segs , i_vline , intrsctn - > iContour , i_intersection , iNext ) ;
// Take the shorter path.
//FIXME this may not be always the best strategy to take the shortest connection line now.
bool take_next = ( intrsctn_type_prev = = INTERSECTION_TYPE_OTHER_VLINE_OK & & intrsctn_type_next = = INTERSECTION_TYPE_OTHER_VLINE_OK ) ?
( distNext < distPrev ) :
intrsctn_type_next = = INTERSECTION_TYPE_OTHER_VLINE_OK ;
2017-07-28 13:47:59 +00:00
assert ( intrsctn - > is_inner ( ) ) ;
2017-07-27 08:39:43 +00:00
bool skip = params . dont_connect | | ( link_max_length > 0 & & ( take_next ? distNext : distPrev ) > link_max_length ) ;
if ( skip ) {
// Just skip the connecting contour and start a new path.
goto dont_connect ;
polyline_current - > points . push_back ( intrsctn - > pos ( ) ) ;
polylines_out . push_back ( Polyline ( ) ) ;
polyline_current = & polylines_out . back ( ) ;
const SegmentedIntersectionLine & il2 = segs [ take_next ? ( i_vline + 1 ) : ( i_vline - 1 ) ] ;
polyline_current - > points . push_back ( il2 . intersections [ take_next ? iNext : iPrev ] . pos ( ) ) ;
} else {
polyline_current - > points . push_back ( intrsctn - > pos ( ) ) ;
emit_perimeter_prev_next_segment ( poly_with_offset , segs , i_vline , intrsctn - > iContour , i_intersection , take_next ? iNext : iPrev , * polyline_current , take_next ) ;
}
// Mark both the left and right connecting segment as consumed, because one cannot go to this intersection point as it has been consumed.
if ( iPrev ! = - 1 )
segs [ i_vline - 1 ] . intersections [ iPrev ] . consumed_perimeter_right = true ;
if ( iNext ! = - 1 )
intrsctn - > consumed_perimeter_right = true ;
//FIXME consume the left / right connecting segments at the other end of this line? Currently it is not critical because a perimeter segment is not followed if the vertical segment at the other side has already been consumed.
// Advance to the neighbor line.
if ( take_next ) {
+ + i_vline ;
i_intersection = iNext ;
} else {
- - i_vline ;
i_intersection = iPrev ;
}
continue ;
}
// 5) Try to connect to a previous or next point on the same vertical line.
if ( vert_seg_dir_valid_mask ) {
bool valid = true ;
// Verify, that there is no intersection with the inner contour up to the end of the contour segment.
// Verify, that the successive segment has not been consumed yet.
if ( going_up ) {
if ( seg . intersections [ iAbove ] . consumed_vertical_up ) {
valid = false ;
} else {
for ( int i = ( int ) i_intersection + 1 ; i < iAbove & & valid ; + + i )
if ( seg . intersections [ i ] . is_inner ( ) )
valid = false ;
}
} else {
if ( seg . intersections [ iBelow - 1 ] . consumed_vertical_up ) {
valid = false ;
} else {
for ( int i = iBelow + 1 ; i < ( int ) i_intersection & & valid ; + + i )
if ( seg . intersections [ i ] . is_inner ( ) )
valid = false ;
}
}
if ( valid ) {
const Polygon & poly = poly_with_offset . contour ( intrsctn - > iContour ) ;
int iNext = going_up ? iAbove : iBelow ;
int iSegNext = going_up ? iSegAbove : iSegBelow ;
bool dir_forward = ( vert_seg_dir_valid_mask = = ( DIR_FORWARD | DIR_BACKWARD ) ) ?
// Take the shorter length between the current and the next intersection point.
( distance_of_segmens ( poly , intrsctn - > iSegment , iSegNext , true ) <
distance_of_segmens ( poly , intrsctn - > iSegment , iSegNext , false ) ) :
( vert_seg_dir_valid_mask = = DIR_FORWARD ) ;
// Skip this perimeter line?
bool skip = params . dont_connect ;
if ( ! skip & & link_max_length > 0 ) {
coordf_t link_length = measure_perimeter_segment_on_vertical_line_length (
poly_with_offset , segs , i_vline , intrsctn - > iContour , i_intersection , iNext , dir_forward ) ;
skip = link_length > link_max_length ;
}
polyline_current - > points . push_back ( intrsctn - > pos ( ) ) ;
if ( skip ) {
// Just skip the connecting contour and start a new path.
polylines_out . push_back ( Polyline ( ) ) ;
polyline_current = & polylines_out . back ( ) ;
polyline_current - > points . push_back ( seg . intersections [ iNext ] . pos ( ) ) ;
} else {
// Consume the connecting contour and the next segment.
emit_perimeter_segment_on_vertical_line ( poly_with_offset , segs , i_vline , intrsctn - > iContour , i_intersection , iNext , * polyline_current , dir_forward ) ;
}
// Mark both the left and right connecting segment as consumed, because one cannot go to this intersection point as it has been consumed.
// If there are any outer intersection points skipped (bypassed) by the contour,
// mark them as processed.
if ( going_up ) {
for ( int i = ( int ) i_intersection ; i < iAbove ; + + i )
seg . intersections [ i ] . consumed_vertical_up = true ;
} else {
for ( int i = iBelow ; i < ( int ) i_intersection ; + + i )
seg . intersections [ i ] . consumed_vertical_up = true ;
}
// seg.intersections[going_up ? i_intersection : i_intersection - 1].consumed_vertical_up = true;
intrsctn - > consumed_perimeter_right = true ;
i_intersection = iNext ;
if ( going_up )
+ + intrsctn ;
else
- - intrsctn ;
intrsctn - > consumed_perimeter_right = true ;
continue ;
}
}
dont_connect :
// No way to continue the current polyline. Take the rest of the line up to the outer contour.
// This will finish the polyline, starting another polyline at a new point.
if ( going_up )
+ + intrsctn ;
else
- - intrsctn ;
}
// Finish the current vertical line,
// reset the current vertical line to pick a new starting point in the next round.
2017-07-28 13:47:59 +00:00
assert ( intrsctn - > is_outer ( ) ) ;
assert ( intrsctn - > is_high ( ) = = going_up ) ;
2017-07-27 08:39:43 +00:00
pointLast = intrsctn - > pos ( ) ;
polyline_current - > points . push_back ( pointLast ) ;
// Handle duplicate points and zero length segments.
polyline_current - > remove_duplicate_points ( ) ;
2017-07-28 13:47:59 +00:00
assert ( ! polyline_current - > has_duplicate_points ( ) ) ;
2017-07-27 08:39:43 +00:00
// Handle nearly zero length edges.
if ( polyline_current - > points . size ( ) < = 1 | |
( polyline_current - > points . size ( ) = = 2 & &
2018-08-17 13:53:43 +00:00
std : : abs ( polyline_current - > points . front ( ) ( 0 ) - polyline_current - > points . back ( ) ( 0 ) ) < SCALED_EPSILON & &
std : : abs ( polyline_current - > points . front ( ) ( 1 ) - polyline_current - > points . back ( ) ( 1 ) ) < SCALED_EPSILON ) )
2017-07-27 08:39:43 +00:00
polylines_out . pop_back ( ) ;
intrsctn = NULL ;
i_intersection = - 1 ;
polyline_current = NULL ;
}
# ifdef SLIC3R_DEBUG
{
static int iRun = 0 ;
BoundingBox bbox_svg = poly_with_offset . bounding_box_outer ( ) ;
{
: : Slic3r : : SVG svg ( debug_out_path ( " FillRectilinear2-final-%03d.svg " , iRun ) , bbox_svg ) ; // , scale_(1.));
poly_with_offset . export_to_svg ( svg ) ;
for ( size_t i = n_polylines_out_initial ; i < polylines_out . size ( ) ; + + i )
svg . draw ( polylines_out [ i ] . lines ( ) , " black " ) ;
}
// Paint a picture per polyline. This makes it easier to discover the order of the polylines and their overlap.
for ( size_t i_polyline = n_polylines_out_initial ; i_polyline < polylines_out . size ( ) ; + + i_polyline ) {
: : Slic3r : : SVG svg ( debug_out_path ( " FillRectilinear2-final-%03d-%03d.svg " , iRun , i_polyline ) , bbox_svg ) ; // , scale_(1.));
svg . draw ( polylines_out [ i_polyline ] . lines ( ) , " black " ) ;
}
}
# endif /* SLIC3R_DEBUG */
// paths must be rotated back
for ( Polylines : : iterator it = polylines_out . begin ( ) + n_polylines_out_initial ; it ! = polylines_out . end ( ) ; + + it ) {
// No need to translate, the absolute position is irrelevant.
2018-08-17 13:53:43 +00:00
// it->translate(- rotate_vector.second(0), - rotate_vector.second(1));
2017-07-28 13:47:59 +00:00
assert ( ! it - > has_duplicate_points ( ) ) ;
2017-07-27 08:39:43 +00:00
//it->rotate(rotate_vector.first);
//FIXME rather simplify the paths to avoid very short edges?
2017-07-28 13:47:59 +00:00
//assert(! it->has_duplicate_points());
2017-07-27 08:39:43 +00:00
it - > remove_duplicate_points ( ) ;
}
# ifdef SLIC3R_DEBUG
// Verify, that there are no duplicate points in the sequence.
for ( Polyline & polyline : polylines_out )
2017-07-28 13:47:59 +00:00
assert ( ! polyline . has_duplicate_points ( ) ) ;
2017-07-27 08:39:43 +00:00
# endif /* SLIC3R_DEBUG */
return true ;
}
} ; // namespace FillRectilinear3_Internal
bool FillRectilinear3 : : fill_surface_by_lines ( const Surface * surface , const FillParams & params , std : : vector < FillDirParams > & fill_dir_params , Polylines & polylines_out )
{
2017-07-28 13:47:59 +00:00
assert ( params . density > 0.0001f & & params . density < = 1.f ) ;
2017-07-27 08:39:43 +00:00
const float INFILL_OVERLAP_OVER_SPACING = 0.45f ;
2017-07-28 13:47:59 +00:00
assert ( INFILL_OVERLAP_OVER_SPACING > 0 & & INFILL_OVERLAP_OVER_SPACING < 0.5f ) ;
2017-07-27 08:39:43 +00:00
// On the polygons of poly_with_offset, the infill lines will be connected.
FillRectilinear3_Internal : : ExPolygonWithOffset poly_with_offset (
surface - > expolygon ,
float ( scale_ ( - ( 0.5 - INFILL_OVERLAP_OVER_SPACING ) * this - > spacing ) ) ,
float ( scale_ ( - 0.5 * this - > spacing ) ) ) ;
if ( poly_with_offset . n_contours_inner = = 0 ) {
// Not a single infill line fits.
//FIXME maybe one shall trigger the gap fill here?
return true ;
}
// Rotate polygons so that we can work with vertical lines here
std : : pair < float , Point > rotate_vector = this - > _infill_direction ( surface ) ;
std : : vector < FillRectilinear3_Internal : : InfillHatchingSingleDirection > hatching ( fill_dir_params . size ( ) , FillRectilinear3_Internal : : InfillHatchingSingleDirection ( ) ) ;
for ( size_t i = 0 ; i < hatching . size ( ) ; + + i )
if ( ! FillRectilinear3_Internal : : prepare_infill_hatching_segments ( poly_with_offset , params , fill_dir_params [ i ] , rotate_vector , hatching [ i ] ) )
return false ;
for ( size_t i = 0 ; i < hatching . size ( ) ; + + i )
if ( ! FillRectilinear3_Internal : : fill_hatching_segments_legacy (
poly_with_offset ,
params ,
this - > link_max_length ,
hatching [ i ] ,
polylines_out ) )
return false ;
return true ;
}
Polylines FillRectilinear3 : : fill_surface ( const Surface * surface , const FillParams & params )
{
Polylines polylines_out ;
std : : vector < FillDirParams > fill_dir_params ;
fill_dir_params . emplace_back ( FillDirParams ( this - > spacing , 0.f ) ) ;
if ( ! fill_surface_by_lines ( surface , params , fill_dir_params , polylines_out ) )
printf ( " FillRectilinear3::fill_surface() failed to fill a region. \n " ) ;
if ( params . full_infill ( ) & & ! params . dont_adjust )
// Return back the adjusted spacing.
this - > spacing = fill_dir_params . front ( ) . spacing ;
return polylines_out ;
}
Polylines FillGrid3 : : fill_surface ( const Surface * surface , const FillParams & params )
{
// Each linear fill covers half of the target coverage.
FillParams params2 = params ;
params2 . density * = 0.5f ;
Polylines polylines_out ;
std : : vector < FillDirParams > fill_dir_params ;
fill_dir_params . emplace_back ( FillDirParams ( this - > spacing , 0.f ) ) ;
fill_dir_params . emplace_back ( FillDirParams ( this - > spacing , float ( M_PI / 2. ) ) ) ;
if ( ! fill_surface_by_lines ( surface , params2 , fill_dir_params , polylines_out ) )
printf ( " FillGrid3::fill_surface() failed to fill a region. \n " ) ;
return polylines_out ;
}
Polylines FillTriangles3 : : fill_surface ( const Surface * surface , const FillParams & params )
{
// Each linear fill covers 1/3 of the target coverage.
FillParams params2 = params ;
params2 . density * = 0.333333333f ;
Polylines polylines_out ;
std : : vector < FillDirParams > fill_dir_params ;
fill_dir_params . emplace_back ( FillDirParams ( this - > spacing , 0. ) ) ;
fill_dir_params . emplace_back ( FillDirParams ( this - > spacing , M_PI / 3. ) ) ;
fill_dir_params . emplace_back ( FillDirParams ( this - > spacing , 2. * M_PI / 3. ) ) ;
if ( ! fill_surface_by_lines ( surface , params2 , fill_dir_params , polylines_out ) )
printf ( " FillTriangles3::fill_surface() failed to fill a region. \n " ) ;
return polylines_out ;
}
Polylines FillStars3 : : fill_surface ( const Surface * surface , const FillParams & params )
{
// Each linear fill covers 1/3 of the target coverage.
FillParams params2 = params ;
params2 . density * = 0.333333333f ;
Polylines polylines_out ;
std : : vector < FillDirParams > fill_dir_params ;
fill_dir_params . emplace_back ( FillDirParams ( this - > spacing , 0. ) ) ;
fill_dir_params . emplace_back ( FillDirParams ( this - > spacing , M_PI / 3. ) ) ;
fill_dir_params . emplace_back ( FillDirParams ( this - > spacing , 2. * M_PI / 3. , 0.5 * this - > spacing / params2 . density ) ) ;
if ( ! fill_surface_by_lines ( surface , params2 , fill_dir_params , polylines_out ) )
printf ( " FillStars3::fill_surface() failed to fill a region. \n " ) ;
return polylines_out ;
}
Polylines FillCubic3 : : fill_surface ( const Surface * surface , const FillParams & params )
{
// Each linear fill covers 1/3 of the target coverage.
FillParams params2 = params ;
params2 . density * = 0.333333333f ;
Polylines polylines_out ;
std : : vector < FillDirParams > fill_dir_params ;
2017-10-03 09:29:13 +00:00
coordf_t dx = sqrt ( 0.5 ) * z ;
fill_dir_params . emplace_back ( FillDirParams ( this - > spacing , 0. , dx ) ) ;
fill_dir_params . emplace_back ( FillDirParams ( this - > spacing , M_PI / 3. , - dx ) ) ;
fill_dir_params . emplace_back ( FillDirParams ( this - > spacing , 2. * M_PI / 3. , dx ) ) ;
2017-07-27 08:39:43 +00:00
if ( ! fill_surface_by_lines ( surface , params2 , fill_dir_params , polylines_out ) )
printf ( " FillCubic3::fill_surface() failed to fill a region. \n " ) ;
return polylines_out ;
}
} // namespace Slic3r