1720 lines
75 KiB
Python
1720 lines
75 KiB
Python
|
#!/usr/bin/env python
|
||
|
|
||
|
# eggbot_hatch.py
|
||
|
#
|
||
|
# Generate hatch fills for the closed paths (polygons) in the currently
|
||
|
# selected document elements. If no elements are selected, then all the
|
||
|
# polygons throughout the document are hatched. The fill rule is an odd/even
|
||
|
# rule: odd numbered intersections (1, 3, 5, etc.) are a hatch line entering
|
||
|
# a polygon while even numbered intersections (2, 4, 6, etc.) are the same
|
||
|
# hatch line exiting the polygon.
|
||
|
#
|
||
|
# This extension first decomposes the selected <path>, <rect>, <line>,
|
||
|
# <polyline>, <polygon>, <circle>, and <ellipse> elements into individual
|
||
|
# moveto and lineto coordinates using the same procedure that eggbot.py uses
|
||
|
# for plotting. These coordinates are then used to build vertex lists.
|
||
|
# Only the vertex lists corresponding to polygons (closed paths) are
|
||
|
# kept. Note that a single graphical element may be composed of several
|
||
|
# subpaths, each subpath potentially a polygon.
|
||
|
#
|
||
|
# Once the lists of all the vertices are built, potential hatch lines are
|
||
|
# "projected" through the bounding box containing all of the vertices.
|
||
|
# For each potential hatch line, all intersections with all the polygon
|
||
|
# edges are determined. These intersections are stored as decimal fractions
|
||
|
# indicating where along the length of the hatch line the intersection
|
||
|
# occurs. These values will always be in the range [0, 1]. A value of 0
|
||
|
# indicates that the intersection is at the start of the hatch line, a value
|
||
|
# of 0.5 midway, and a value of 1 at the end of the hatch line.
|
||
|
#
|
||
|
# For a given hatch line, all the fractional values are sorted and any
|
||
|
# duplicates removed. Duplicates occur, for instance, when the hatch
|
||
|
# line passes through a polygon vertex and thus intersects two edges
|
||
|
# segments of the polygon: the end of one edge and the start of
|
||
|
# another.
|
||
|
#
|
||
|
# Once sorted and duplicates removed, an odd/even rule is applied to
|
||
|
# determine which segments of the potential hatch line are within
|
||
|
# polygons. These segments found to be within polygons are then saved
|
||
|
# and become the hatch fill lines which will be drawn.
|
||
|
#
|
||
|
# With each saved hatch fill line, information about which SVG graphical
|
||
|
# element it is within is saved. This way, the hatch fill lines can
|
||
|
# later be grouped with the element they are associated with. This makes
|
||
|
# it possible to manipulate the two -- graphical element and hatch lines --
|
||
|
# as a single object within Inkscape.
|
||
|
#
|
||
|
# Note: we also save the transformation matrix for each graphical element.
|
||
|
# That way, when we group the hatch fills with the element they are
|
||
|
# filling, we can invert the transformation. That is, in order to compute
|
||
|
# the hatch fills, we first have had apply ALL applicable transforms to
|
||
|
# all the graphical elements. We need to do that so that we know where in
|
||
|
# the drawing each of the graphical elements are relative to one another.
|
||
|
# However, this means that the hatch lines have been computed in a setting
|
||
|
# where no further transforms are needed. If we then put these hatch lines
|
||
|
# into the same groups as the elements being hatched in the ORIGINAL
|
||
|
# drawing, then the hatch lines will have transforms applied again. So,
|
||
|
# once we compute the hatch lines, we need to invert the transforms of
|
||
|
# the group they will be placed in and apply this inverse transform to the
|
||
|
# hatch lines. Hence the need to save the transform matrix for every
|
||
|
# graphical element.
|
||
|
|
||
|
# Written by Daniel C. Newman for the Eggbot Project
|
||
|
# dan dot newman at mtbaldy dot us
|
||
|
# Last updated 28 November 2010
|
||
|
# 15 October 2010
|
||
|
|
||
|
# Updated by Windell H. Oskay, 6/14/2012
|
||
|
# Added tolerance parameter
|
||
|
|
||
|
# Update by Daniel C. Newman, 6/20/2012
|
||
|
# Add min span/gap width
|
||
|
|
||
|
# Updated by Windell H. Oskay, 1/8/2016
|
||
|
# Added live preview and correct issue with nonzero min gap
|
||
|
# https://github.com/evil-mad/EggBot/issues/32
|
||
|
|
||
|
# Updated by Sheldon B. Michaels, 1/11/2016 thru 3/15/2016
|
||
|
# shel at shel dot net
|
||
|
# Added feature: Option to inset the hatch segments from boundaries
|
||
|
# Added feature: Option to join hatch segments that are "nearby", to minimize pen lifts
|
||
|
# The joins are made using cubic Bezier segments.
|
||
|
# https://github.com/evil-mad/EggBot/issues/36
|
||
|
#
|
||
|
# This program is free software; you can redistribute it and/or modify
|
||
|
# it under the terms of the GNU General Public License as published by
|
||
|
# the Free Software Foundation; either version 2 of the License, or
|
||
|
# (at your option) any later version.
|
||
|
#
|
||
|
# This program is distributed in the hope that it will be useful,
|
||
|
# but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
# GNU General Public License for more details.
|
||
|
#
|
||
|
# You should have received a copy of the GNU General Public License
|
||
|
# along with this program; if not, write to the Free Software
|
||
|
# Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||
|
|
||
|
import inkex
|
||
|
import simplepath
|
||
|
import simpletransform
|
||
|
import simplestyle
|
||
|
import cubicsuperpath
|
||
|
import cspsubdiv
|
||
|
import bezmisc
|
||
|
import math
|
||
|
import plot_utils # https://github.com/evil-mad/plotink
|
||
|
|
||
|
|
||
|
N_PAGE_WIDTH = 3200
|
||
|
N_PAGE_HEIGHT = 800
|
||
|
|
||
|
F_MINGAP_SMALL_VALUE = 0.0000000001 # Was 0.00001 in the original version which did not have joined lines.
|
||
|
# Reducing this by a factor of 10^5 decreased probability of occurrence of
|
||
|
# the bug in the original, which got confused when the path barely
|
||
|
# grazed a corner.
|
||
|
BEZIER_OVERSHOOT_MULTIPLIER = 0.75 # evaluation of cubic Bezier curve equation value,
|
||
|
# at x = 0, with
|
||
|
# endpoints at ( -0.5, 0 ), ( +0.5, 0 )
|
||
|
# and control points at ( -0.5, 1.0 ), ( +0.5, 1.0 )
|
||
|
|
||
|
RADIAN_TOLERANCE_FOR_COLINEAR = 0.1 # Pragmatically adjusted to allow adjacent segments from the same scan line, even short ones,
|
||
|
# to be classified as having the same angle
|
||
|
RADIAN_TOLERANCE_FOR_ALTERNATING_DIRECTION = 0.1 # Pragmatic adjustment again, as with colinearity tolerance
|
||
|
RECURSION_LIMIT = 500 # Pragmatic - if too high, risk runtime python error; if too low, miss some chances for reducing pen lifts
|
||
|
EXTREME_POSITIVE_NUMBER = float( 1.0E70 )
|
||
|
EXTREME_NEGATIVE_NUMBER = float( -1.0E70 )
|
||
|
MIN_HATCH_LENGTH_AS_FRACTION_OF_HATCH_SPACING = 0.25 # set minimum hatch length to some function
|
||
|
# (e.g. this multiplier) of the hatch spacing
|
||
|
'''
|
||
|
Geometry 101: Determining if two lines intersect
|
||
|
|
||
|
A line L is defined by two points in space P1 and P2. Any point P on the
|
||
|
line L satisfies
|
||
|
|
||
|
P = P1 + s (P2 - P1)
|
||
|
|
||
|
for some value of the real number s in the range (-infinity, infinity).
|
||
|
If we confine s to the range [0, 1] then we've described the line segment
|
||
|
with end points P1 and P2.
|
||
|
|
||
|
Consider now the line La defined by the points P1 and P2, and the line Lb
|
||
|
defined by the points P3 and P4. Any points Pa and Pb on the lines La and
|
||
|
Lb therefore satisfy
|
||
|
|
||
|
Pa = P1 + sa (P2 - P1)
|
||
|
Pb = P3 + sb (P4 - P3)
|
||
|
|
||
|
for some values of the real numbers sa and sb. To see if these two lines
|
||
|
La and Lb intersect, we wish to see if there are finite values sa and sb
|
||
|
for which
|
||
|
|
||
|
Pa = Pb
|
||
|
|
||
|
Or, equivalently, we ask if there exists values of sa and sb for which
|
||
|
the equation
|
||
|
|
||
|
P1 + sa (P2 - P1) = P3 + sb (P4 - P3)
|
||
|
|
||
|
holds. If we confine ourselves to a two-dimensional plane, and take
|
||
|
|
||
|
P1 = (x1, y1)
|
||
|
P2 = (x2, y2)
|
||
|
P3 = (x3, y3)
|
||
|
P4 = (x4, y4)
|
||
|
|
||
|
we then find that we have two equations in two unknowns, sa and sb,
|
||
|
|
||
|
x1 + sa ( x2 - x1 ) = x3 + sb ( x4 - x3 )
|
||
|
y1 + sa ( y2 - y1 ) = y3 + sb ( y4 - y3 )
|
||
|
|
||
|
Solving these two equations for sa and sb yields,
|
||
|
|
||
|
sa = [ ( y1 - y3 ) ( x4 - x3 ) - ( y4 - y3 ) ( x1 - x3 ) ] / d
|
||
|
sb = [ ( y1 - y3 ) ( x2 - x1 ) - ( y2 - y1 ) ( x1 - x3 ) ] / d
|
||
|
|
||
|
where the denominator, d, is given by
|
||
|
|
||
|
d = ( y4 - y3 ) ( x2 - x1 ) - ( y2 - y1 ) ( x4 - x3 )
|
||
|
|
||
|
Substituting these back for the point (x, y) of intersection gives
|
||
|
|
||
|
x = x1 + sa ( x2 - x1 )
|
||
|
y = y1 + sa ( y2 - y1 )
|
||
|
|
||
|
Note that
|
||
|
|
||
|
1. The lines are parallel when d = 0
|
||
|
2. The lines are coincident d = 0 and the numerators for sa & sb are zero
|
||
|
3. For line segments, sa and sb are in the range [0, 1]; any value outside
|
||
|
that range indicates that the line segments do not intersect.
|
||
|
'''
|
||
|
|
||
|
def intersect( P1, P2, P3, P4 ):
|
||
|
|
||
|
'''
|
||
|
Determine if two line segments defined by the four points P1 & P2 and
|
||
|
P3 & P4 intersect. If they do intersect, then return the fractional
|
||
|
point of intersection "sa" along the first line at which the
|
||
|
intersection occurs.
|
||
|
'''
|
||
|
|
||
|
# Precompute these values -- note that we're basically shifting from
|
||
|
#
|
||
|
# P = P1 + s (P2 - P1)
|
||
|
#
|
||
|
# to
|
||
|
#
|
||
|
# P = P1 + s D
|
||
|
#
|
||
|
# where D is a direction vector. The solution remains the same of
|
||
|
# course. We'll just be computing D once for each line rather than
|
||
|
# computing it a couple of times.
|
||
|
|
||
|
D21x = P2[0] - P1[0]
|
||
|
D21y = P2[1] - P1[1]
|
||
|
D43x = P4[0] - P3[0]
|
||
|
D43y = P4[1] - P3[1]
|
||
|
|
||
|
# Denominator
|
||
|
d = D21x * D43y - D21y * D43x
|
||
|
|
||
|
# Return now if the denominator is zero
|
||
|
if d == 0:
|
||
|
return float( -1 )
|
||
|
|
||
|
# For our purposes, the first line segment given
|
||
|
# by P1 & P2 is the LONG hatch line running through
|
||
|
# the entire drawing. And, P3 & P4 describe the
|
||
|
# usually much shorter line segment from a polygon.
|
||
|
# As such, we compute sb first as it's more likely
|
||
|
# to indicate "no intersection". That is, sa is
|
||
|
# more likely to indicate an intersection with a
|
||
|
# much a long line containing P3 & P4.
|
||
|
|
||
|
nb = ( P1[1] - P3[1] ) * D21x - ( P1[0] - P3[0] ) * D21y
|
||
|
|
||
|
# Could first check if abs(nb) > abs(d) or if
|
||
|
# the signs differ.
|
||
|
sb = float( nb ) / float( d )
|
||
|
if ( sb < 0 ) or ( sb > 1 ):
|
||
|
return float( -1 )
|
||
|
|
||
|
na = ( P1[1] - P3[1] ) * D43x - ( P1[0] - P3[0] ) * D43y
|
||
|
sa = float( na ) / float( d )
|
||
|
if ( sa < 0 ) or ( sa > 1 ):
|
||
|
return float( -1 )
|
||
|
|
||
|
return sa
|
||
|
|
||
|
def interstices( self, P1, P2, paths, hatches, bHoldBackHatches, fHoldBackSteps ):
|
||
|
|
||
|
'''
|
||
|
For the line L defined by the points P1 & P2, determine the segments
|
||
|
of L which lie within the polygons described by the paths stored in
|
||
|
"paths"
|
||
|
|
||
|
P1 -- (x,y) coordinate [list]
|
||
|
P2 -- (x,y) coordinate [list]
|
||
|
paths -- Dictionary of all the paths to check for intersections
|
||
|
|
||
|
When an intersection of the line L is found with a polygon edge, then
|
||
|
the fractional distance along the line L is saved along with the
|
||
|
lxml.etree node which contained the intersecting polygon edge. This
|
||
|
fractional distance is always in the range [0, 1].
|
||
|
|
||
|
Once all polygons have been checked, the list of fractional distances
|
||
|
corresponding to intersections is sorted and any duplicates removed.
|
||
|
It is then assumed that the first intersection is the line L entering
|
||
|
a polygon; the second intersection the line leaving the polygon. This
|
||
|
line segment defined by the first and second intersection points is
|
||
|
thus a hatch fill line we sought to generate. In general, our hatch
|
||
|
fills become the line segments described by intersection i and i+1
|
||
|
with i an odd value (1, 3, 5, ...). Since we know the lxml.etree node
|
||
|
corresponding to each intersection, we can then correlate the hatch
|
||
|
fill lines to the graphical elements in the original SVG document.
|
||
|
This enables us to group hatch lines with the elements being hatched.
|
||
|
|
||
|
The hatch line segments are returned by populating a dictionary.
|
||
|
The dictionary is keyed off of the lxml.etree node pointer. Each
|
||
|
dictionary value is a list of 4-tuples,
|
||
|
|
||
|
(x1, y1, x2, y2)
|
||
|
|
||
|
where (x1, y1) and (x2, y2) are the (x,y) coordinates of the line
|
||
|
segment's starting and ending points.
|
||
|
'''
|
||
|
|
||
|
dAndA = []
|
||
|
# P1 & P2 is the hatch line
|
||
|
# P3 & P4 is the polygon edge to check
|
||
|
for path in paths:
|
||
|
for subpath in paths[path]:
|
||
|
P3 = subpath[0]
|
||
|
for P4 in subpath[1:]:
|
||
|
s = intersect( P1, P2, P3, P4 )
|
||
|
if ( s >= 0.0 ) and ( s <= 1.0 ):
|
||
|
# Save this intersection point along the hatch line
|
||
|
if bHoldBackHatches:
|
||
|
# We will need to know how the hatch meets the polygon segment, so that we can
|
||
|
# calculate the end of a shorter line that stops short
|
||
|
# of the polygon segment.
|
||
|
# We compute the angle now while we have the information required,
|
||
|
# but do _not_ apply it now, as we need the real,original, intersects
|
||
|
# for the odd/even inside/outside operations yet to come.
|
||
|
# Note that though the intersect() routine _could_ compute the join angle,
|
||
|
# we do it here because we go thru here much less often than we go thru intersect().
|
||
|
angleHatchRadians = math.atan2( -( P2[1] - P1[1] ) ,( P2[0] - P1[0] ) ) # from P1 toward P2, cartesian coordinates
|
||
|
angleSegmentRadians = math.atan2( -( P4[1] - P3[1] ) ,( P4[0] - P3[0] ) ) # from P3 toward P4, cartesian coordinates
|
||
|
angleDifferenceRadians = angleHatchRadians - angleSegmentRadians
|
||
|
# coerce to range -pi to +pi
|
||
|
if ( angleDifferenceRadians > math.pi ):
|
||
|
angleDifferenceRadians -= 2 * math.pi
|
||
|
elif (angleDifferenceRadians < -math.pi ):
|
||
|
angleDifferenceRadians += 2 * math.pi
|
||
|
fSinOfJoinAngle = math.sin( angleDifferenceRadians )
|
||
|
fAbsSinOfJoinAngle = abs( fSinOfJoinAngle )
|
||
|
if (fAbsSinOfJoinAngle != 0.0): # Worrying about case of intersecting a segment parallel to the hatch
|
||
|
fPreliminaryLengthToBeRemovedFromPt = fHoldBackSteps / fAbsSinOfJoinAngle
|
||
|
bUnconditionallyExciseHatch = False
|
||
|
else: # if (fSinOfJoinAngle != 0.0):
|
||
|
bUnconditionallyExciseHatch = True
|
||
|
# if (fAbsSinOfJoinAngle != 0.0): else:
|
||
|
|
||
|
if ( not bUnconditionallyExciseHatch):
|
||
|
# if ( fPreliminaryLengthToBeRemovedFromPt > ( distance from intersection to relevant end + fHoldbackSteps ) ):
|
||
|
# fFinalLengthToBeRemovedFromPt = ( distance from intersection to relevant end + fHoldbackSteps )
|
||
|
# The relevant end of the segment is the end from which the hatch approaches at an acute angle.
|
||
|
I = [0,0]
|
||
|
I[0] = P1[0] + s * ( P2[0] - P1[0] ) # compute intersection point of hatch with segment
|
||
|
I[1] = P1[1] + s * ( P2[1] - P1[1] ) # intersecting hatch line starts at P1, vectored toward P2,
|
||
|
# but terminates at intersection I
|
||
|
# Note that atan2 returns answer in range -pi to pi
|
||
|
# Which end is the approach end of the hatch to the segment?
|
||
|
# The dot product tells the answer:
|
||
|
# if dot product is positive, P2 is at the P4 end,
|
||
|
# else P2 is at the P3 end
|
||
|
# We really don't need to take the time to actually take
|
||
|
# the cosine of the angle, we are just interested in
|
||
|
# the quadrant within which the angle lies.
|
||
|
# I'm sure there is an elegant way to do this, but I'll settle for results just now.
|
||
|
# If the angle is in quadrants I or IV then P4 is the relevant end, otherwise P3 is
|
||
|
# nb: Y increases down, rather than up
|
||
|
# nb: difference angle has been forced to the range -pi to +pi
|
||
|
if ( abs(angleDifferenceRadians) < math.pi / 2 ):
|
||
|
# It's near the P3 the relevant end from which the hatch departs
|
||
|
fDistanceFromIntersectionToRelevantEnd = math.hypot( P3[0] - I[0], P3[1] - I[1] )
|
||
|
fDistanceFromIntersectionToIrrelevantEnd = math.hypot( P4[0] - I[0], P4[1] - I[1] )
|
||
|
else: # if ( abs(angleDifferenceRadians) < math.pi / 2 )
|
||
|
# It's near the P4 end from which the hatch departs
|
||
|
fDistanceFromIntersectionToRelevantEnd = math.hypot( P4[0] - I[0], P4[1] - I[1] )
|
||
|
fDistanceFromIntersectionToIrrelevantEnd = math.hypot( P3[0] - I[0], P3[1] - I[1] )
|
||
|
# if ( abs(angleDifferenceRadians) < math.pi / 2 ): else:
|
||
|
|
||
|
# Now, the problem defined in issue 22 is that we may not need to remove the
|
||
|
# entire preliminary length we've calculated. This problem occurs because
|
||
|
# we have so far been considering the polygon segment as a line of infinite extent.
|
||
|
# Thus, we may be holding back at a point where no holdback is required, when
|
||
|
# calculated holdback is well beyond the position of the segment end.
|
||
|
|
||
|
# To make matters worse, we do not currently know whether we're
|
||
|
# starting a hatch or terminating a hatch, because the duplicates have
|
||
|
# yet to be removed. All we can do then, is calculate the required
|
||
|
# line shortening for both possibilities - and then choose the correct
|
||
|
# one after duplicate-removal, when actually finalizing the hatches.
|
||
|
|
||
|
# Let's see if either end, or perhaps both ends, has a case of excessive holdback
|
||
|
|
||
|
# First, default assumption is that neither end has excessive holdback
|
||
|
fFinalLengthToBeRemovedFromPtWhenStartingHatch = fPreliminaryLengthToBeRemovedFromPt
|
||
|
fFinalLengthToBeRemovedFromPtWhenEndingHatch = fPreliminaryLengthToBeRemovedFromPt
|
||
|
|
||
|
# Now check each of the two ends
|
||
|
if ( fPreliminaryLengthToBeRemovedFromPt > ( fDistanceFromIntersectionToRelevantEnd + fHoldBackSteps ) ):
|
||
|
# Yes, would be excessive holdback approaching from this direction
|
||
|
fFinalLengthToBeRemovedFromPtWhenStartingHatch = fDistanceFromIntersectionToRelevantEnd + fHoldBackSteps
|
||
|
# if ( fPreliminaryLengthToBeRemovedFromPt > ( fDistanceFromIntersectionToRelevantEnd + fHoldBackSteps ) ):
|
||
|
if ( fPreliminaryLengthToBeRemovedFromPt > ( fDistanceFromIntersectionToIrrelevantEnd + fHoldBackSteps ) ):
|
||
|
# Yes, would be excessive holdback approaching from other direction
|
||
|
fFinalLengthToBeRemovedFromPtWhenEndingHatch = fDistanceFromIntersectionToIrrelevantEnd + fHoldBackSteps
|
||
|
# if ( fPreliminaryLengthToBeRemovedFromPt > ( fDistanceFromIntersectionToIrrelevantEnd + fHoldBackSteps ) ):
|
||
|
|
||
|
dAndA.append( ( s, path, fFinalLengthToBeRemovedFromPtWhenStartingHatch, fFinalLengthToBeRemovedFromPtWhenEndingHatch ) )
|
||
|
else: # if ( not bUnconditionallyExciseHatch):
|
||
|
dAndA.append( ( s, path, 123456.0, 123456.0 ) ) # Mark for complete hatch excision, hatch is parallel to segment
|
||
|
# Just a random number guaranteed large enough to be longer than any hatch length
|
||
|
# if ( not bUnconditionallyExciseHatch): else :
|
||
|
else: # if bHoldBackHatches:
|
||
|
dAndA.append( ( s, path, 0, 0 ) ) # zero length to be removed from hatch
|
||
|
# if bHoldBackHatches: else:
|
||
|
# if ( s >= 0.0 ) and ( s <= 1.0 ):
|
||
|
P3 = P4
|
||
|
# for P4 in subpath[1:]:
|
||
|
# for subpath in paths[path]:
|
||
|
# for path in paths:
|
||
|
|
||
|
# Return now if there were no intersections
|
||
|
if len( dAndA ) == 0:
|
||
|
return None
|
||
|
|
||
|
dAndA.sort()
|
||
|
|
||
|
# Remove duplicate intersections. A common case where these arise
|
||
|
# is when the hatch line passes through a vertex where one line segment
|
||
|
# ends and the next one begins.
|
||
|
|
||
|
# Having sorted the data, it's trivial to just scan through
|
||
|
# removing duplicates as we go and then truncating the array
|
||
|
|
||
|
n = len( dAndA )
|
||
|
ilast = i = 1
|
||
|
last = dAndA[0]
|
||
|
while i < n:
|
||
|
if ( ( abs( dAndA[i][0] - last[0] ) ) > F_MINGAP_SMALL_VALUE ):
|
||
|
dAndA[ilast] = last = dAndA[i]
|
||
|
ilast += 1
|
||
|
i += 1
|
||
|
dAndA = dAndA[:ilast]
|
||
|
if len( dAndA ) < 2:
|
||
|
return
|
||
|
|
||
|
# Now, entries with even valued indices into sa[] are where we start
|
||
|
# a hatch line and odd valued indices where we end the hatch line.
|
||
|
|
||
|
last_dAndA = None
|
||
|
i = 0
|
||
|
while i < ( len( dAndA ) - 1 ):
|
||
|
#for i in range( 0, len( sa ) - 1, 2 ):
|
||
|
if not hatches.has_key( dAndA[i][1] ):
|
||
|
hatches[dAndA[i][1]] = []
|
||
|
|
||
|
x1 = P1[0] + dAndA[i][0] * ( P2[0] - P1[0] )
|
||
|
y1 = P1[1] + dAndA[i][0] * ( P2[1] - P1[1] )
|
||
|
x2 = P1[0] + dAndA[i+1][0] * ( P2[0] - P1[0] )
|
||
|
y2 = P1[1] + dAndA[i+1][0] * ( P2[1] - P1[1] )
|
||
|
|
||
|
# These are the hatch ends if we are _not_ holding off from the boundary.
|
||
|
if not bHoldBackHatches:
|
||
|
hatches[dAndA[i][1]].append( [[x1, y1], [x2, y2]] )
|
||
|
else: # if not bHoldBackHatches:
|
||
|
# User wants us to perform a pseudo inset operation.
|
||
|
# We will accomplish this by trimming back the ends of the hatches.
|
||
|
# The amount by which to trim back depends on the angle between the
|
||
|
# intersecting hatch line with the intersecting polygon segment, and
|
||
|
# may well be different at the two different ends of the hatch line.
|
||
|
|
||
|
# To visualize this, imagine a hatch intersecting a segment that is
|
||
|
# close to parallel with it. The length of the hatch would have to be
|
||
|
# drastically reduced in order that its closest approach to the
|
||
|
# segment be reduced to the desired distance.
|
||
|
|
||
|
# Imagine a Cartesian coordinate system, with the X axis representing the
|
||
|
# polygon segment, and a line running through the origin with a small
|
||
|
# positive slope being the intersecting hatch line.
|
||
|
|
||
|
# We see that we want a Y value of the specified hatch width, and that
|
||
|
# at that Y, the distance from the origin to that point is the
|
||
|
# hypotenuse of the triangle.
|
||
|
# Y / cutlength = sin(angle)
|
||
|
# therefore:
|
||
|
# cutlength = Y / sin(angle)
|
||
|
# Fortunately, we have already stored this angle for exactly this purpose.
|
||
|
# For each end, trim back the hatch line by the amount required by
|
||
|
# its own angle. If the resultant diminished hatch is too short,
|
||
|
# remove it from consideration by marking it as already drawn - a
|
||
|
# fiction, but is much quicker than actually removing the hatch from the list.
|
||
|
|
||
|
fMinAllowedHatchLength = self.options.hatchSpacing * MIN_HATCH_LENGTH_AS_FRACTION_OF_HATCH_SPACING
|
||
|
fInitialHatchLength = math.hypot( x2 - x1, y2 - y1 )
|
||
|
# We did as much as possible of the inset operation back when we were finding intersections.
|
||
|
# We did it back then because at that point we knew more about the geometry than we know now.
|
||
|
# Now we don't know where the ends of the segments are, so we can't address issue 22 here.
|
||
|
fLengthToBeRemovedFromPt1 = dAndA[i][3]
|
||
|
fLengthToBeRemovedFromPt2 = dAndA[i+1][2]
|
||
|
|
||
|
if ( ( fInitialHatchLength - ( fLengthToBeRemovedFromPt1 + fLengthToBeRemovedFromPt2 ) ) \
|
||
|
<= \
|
||
|
fMinAllowedHatchLength ):
|
||
|
pass # Just don't insert it into the hatch list
|
||
|
else: # if (...too short...):
|
||
|
'''
|
||
|
Use:
|
||
|
def RelativeControlPointPosition( self, distance, fDeltaX, fDeltaY, deltaX, deltaY ):
|
||
|
# returns the point, relative to 0, 0 offset by deltaX, deltaY,
|
||
|
# which extends a distance of "distance" at a slope defined by fDeltaX and fDeltaY
|
||
|
'''
|
||
|
pt1 = self.RelativeControlPointPosition( fLengthToBeRemovedFromPt1, x2 - x1, y2 - y1, x1, y1 )
|
||
|
pt2 = self.RelativeControlPointPosition( fLengthToBeRemovedFromPt2, x1 - x2, y1 - y2, x2, y2 )
|
||
|
hatches[dAndA[i][1]].append( [[pt1[0], pt1[1]], [pt2[0], pt2[1]]] )
|
||
|
|
||
|
# if (...too short...): else:
|
||
|
# if not bHoldBackHatches: else:
|
||
|
|
||
|
# Remember the relative start and end of this hatch segment
|
||
|
last_dAndA = [ dAndA[i], dAndA[i+1] ]
|
||
|
|
||
|
i = i + 2
|
||
|
# while i < ( len( dAndA ) - 1 ):
|
||
|
|
||
|
def inverseTransform ( tran ):
|
||
|
'''
|
||
|
An SVG transform matrix looks like
|
||
|
|
||
|
[ a c e ]
|
||
|
[ b d f ]
|
||
|
[ 0 0 1 ]
|
||
|
|
||
|
And it's inverse is
|
||
|
|
||
|
[ d -c cf - de ]
|
||
|
[ -b a be - af ] * ( ad - bc ) ** -1
|
||
|
[ 0 0 1 ]
|
||
|
|
||
|
And, no reasonable 2d coordinate transform will have
|
||
|
the products ad and bc equal.
|
||
|
|
||
|
SVG represents the transform matrix column by column as
|
||
|
matrix(a b c d e f) while Inkscape extensions store the
|
||
|
transform matrix as
|
||
|
|
||
|
[[a, c, e], [b, d, f]]
|
||
|
|
||
|
To invert the transform stored Inskcape style, we wish to
|
||
|
produce
|
||
|
|
||
|
[[d/D, -c/D, (cf - de)/D], [-b/D, a/D, (be-af)/D]]
|
||
|
|
||
|
where
|
||
|
|
||
|
D = 1 / (ad - bc)
|
||
|
'''
|
||
|
|
||
|
D = tran[0][0] * tran[1][1] - tran[1][0] * tran[0][1]
|
||
|
if D == 0:
|
||
|
return None
|
||
|
|
||
|
return [[tran[1][1]/D, -tran[0][1]/D,
|
||
|
(tran[0][1]*tran[1][2] - tran[1][1]*tran[0][2])/D],
|
||
|
[-tran[1][0]/D, tran[0][0]/D,
|
||
|
(tran[1][0]*tran[0][2] - tran[0][0]*tran[1][2])/D]]
|
||
|
|
||
|
def subdivideCubicPath( sp, flat, i=1 ):
|
||
|
|
||
|
"""
|
||
|
Break up a bezier curve into smaller curves, each of which
|
||
|
is approximately a straight line within a given tolerance
|
||
|
(the "smoothness" defined by [flat]).
|
||
|
|
||
|
This is a modified version of cspsubdiv.cspsubdiv() rewritten
|
||
|
to avoid recurrence.
|
||
|
"""
|
||
|
|
||
|
while True:
|
||
|
while True:
|
||
|
if i >= len( sp ):
|
||
|
return
|
||
|
|
||
|
p0 = sp[i - 1][1]
|
||
|
p1 = sp[i - 1][2]
|
||
|
p2 = sp[i][0]
|
||
|
p3 = sp[i][1]
|
||
|
|
||
|
b = ( p0, p1, p2, p3 )
|
||
|
|
||
|
if cspsubdiv.maxdist( b ) > flat:
|
||
|
break
|
||
|
|
||
|
i += 1
|
||
|
|
||
|
one, two = bezmisc.beziersplitatt( b, 0.5 )
|
||
|
sp[i - 1][2] = one[1]
|
||
|
sp[i][0] = two[2]
|
||
|
p = [one[2], one[3], two[1]]
|
||
|
sp[i:1] = [p]
|
||
|
|
||
|
|
||
|
def distanceSquared( P1, P2 ):
|
||
|
|
||
|
'''
|
||
|
Pythagorean distance formula WITHOUT the square root. Since
|
||
|
we just want to know if the distance is less than some fixed
|
||
|
fudge factor, we can just square the fudge factor once and run
|
||
|
with it rather than compute square roots over and over.
|
||
|
'''
|
||
|
|
||
|
dx = P2[0] - P1[0]
|
||
|
dy = P2[1] - P1[1]
|
||
|
|
||
|
return ( dx * dx + dy * dy )
|
||
|
|
||
|
class Eggbot_Hatch( inkex.Effect ):
|
||
|
|
||
|
def __init__( self ):
|
||
|
|
||
|
inkex.Effect.__init__( self )
|
||
|
|
||
|
self.xmin, self.ymin = ( float( 0 ), float( 0 ) )
|
||
|
self.xmax, self.ymax = ( float( 0 ), float( 0 ) )
|
||
|
self.paths = {}
|
||
|
self.grid = []
|
||
|
self.hatches = {}
|
||
|
self.transforms = {}
|
||
|
|
||
|
# For handling an SVG viewbox attribute, we will need to know the
|
||
|
# values of the document's <svg> width and height attributes as well
|
||
|
# as establishing a transform from the viewbox to the display.
|
||
|
self.docWidth = float( N_PAGE_WIDTH )
|
||
|
self.docHeight = float( N_PAGE_HEIGHT )
|
||
|
self.docTransform = [[1.0, 0.0, 0.0], [0.0, 1.0, 0.0]]
|
||
|
|
||
|
|
||
|
self.OptionParser.add_option(
|
||
|
"--holdBackSteps", action="store", type="float",
|
||
|
dest="holdBackSteps", default=3.0,
|
||
|
help="How far hatch strokes stay from boundary (steps)" )
|
||
|
self.OptionParser.add_option(
|
||
|
"--hatchScope", action="store", type="float",
|
||
|
dest="hatchScope", default=3.0,
|
||
|
help="Radius searched for segments to join (units of hatch width)" )
|
||
|
self.OptionParser.add_option(
|
||
|
"--holdBackHatchFromEdges", action="store", dest="holdBackHatchFromEdges",
|
||
|
type="inkbool", default=True,
|
||
|
help="Stay away from edges, so no need for inset" )
|
||
|
self.OptionParser.add_option(
|
||
|
"--reducePenLifts", action="store", dest="reducePenLifts",
|
||
|
type="inkbool", default=True,
|
||
|
help="Reduce plotting time by joining some hatches" )
|
||
|
self.OptionParser.add_option(
|
||
|
"--crossHatch", action="store", dest="crossHatch",
|
||
|
type="inkbool", default=False,
|
||
|
help="Generate a cross hatch pattern" )
|
||
|
self.OptionParser.add_option(
|
||
|
"--hatchAngle", action="store", type="float",
|
||
|
dest="hatchAngle", default=90.0,
|
||
|
help="Angle of inclination for hatch lines" )
|
||
|
self.OptionParser.add_option(
|
||
|
"--hatchSpacing", action="store", type="float",
|
||
|
dest="hatchSpacing", default=10.0,
|
||
|
help="Spacing between hatch lines" )
|
||
|
self.OptionParser.add_option(
|
||
|
"--tolerance", action="store", type="float",
|
||
|
dest="tolerance", default=20.0,
|
||
|
help="Allowed deviation from original paths" )
|
||
|
self.OptionParser.add_option( "--tab", #NOTE: value is not used.
|
||
|
action="store", type="string", dest="tab", default="splash",
|
||
|
help="The active tab when Apply was pressed" )
|
||
|
|
||
|
def getDocProps( self ):
|
||
|
|
||
|
'''
|
||
|
Get the document's height and width attributes from the <svg> tag.
|
||
|
Use a default value in case the property is not present or is
|
||
|
expressed in units of percentages.
|
||
|
'''
|
||
|
|
||
|
self.docHeight = plot_utils.getLength( self, 'height', N_PAGE_HEIGHT )
|
||
|
self.docWidth = plot_utils.getLength( self, 'width', N_PAGE_WIDTH )
|
||
|
|
||
|
if ( self.docHeight == None ) or ( self.docWidth == None ):
|
||
|
return False
|
||
|
else:
|
||
|
return True
|
||
|
|
||
|
def handleViewBox( self ):
|
||
|
|
||
|
'''
|
||
|
Set up the document-wide transform in the event that the document has an SVG viewbox
|
||
|
'''
|
||
|
|
||
|
if self.getDocProps():
|
||
|
viewbox = self.document.getroot().get( 'viewBox' )
|
||
|
if viewbox:
|
||
|
vinfo = viewbox.strip().replace( ',', ' ' ).split( ' ' )
|
||
|
if ( vinfo[2] != 0 ) and ( vinfo[3] != 0 ):
|
||
|
sx = self.docWidth / float( vinfo[2] )
|
||
|
sy = self.docHeight / float( vinfo[3] )
|
||
|
self.docTransform = simpletransform.parseTransform( 'scale(%f,%f)' % (sx, sy) )
|
||
|
|
||
|
def addPathVertices( self, path, node=None, transform=None ):
|
||
|
|
||
|
'''
|
||
|
Decompose the path data from an SVG element into individual
|
||
|
subpaths, each starting with an absolute move-to (x, y)
|
||
|
coordinate followed by one or more absolute line-to (x, y)
|
||
|
coordinates. Each subpath is stored as a list of (x, y)
|
||
|
coordinates, with the first entry understood to be a
|
||
|
move-to coordinate and the rest line-to coordinates. A list
|
||
|
is then made of all the subpath lists and then stored in the
|
||
|
self.paths dictionary using the path's lxml.etree node pointer
|
||
|
as the dictionary key.
|
||
|
'''
|
||
|
|
||
|
if ( not path ) or ( len( path ) == 0 ):
|
||
|
return
|
||
|
|
||
|
# parsePath() may raise an exception. This is okay
|
||
|
sp = simplepath.parsePath( path )
|
||
|
if ( not sp ) or ( len( sp ) == 0 ):
|
||
|
return
|
||
|
|
||
|
# Get a cubic super duper path
|
||
|
p = cubicsuperpath.CubicSuperPath( sp )
|
||
|
if ( not p ) or ( len( p ) == 0 ):
|
||
|
return
|
||
|
|
||
|
# Apply any transformation
|
||
|
if transform != None:
|
||
|
simpletransform.applyTransformToPath( transform, p )
|
||
|
|
||
|
# Now traverse the simplified path
|
||
|
subpaths = []
|
||
|
subpath_vertices = []
|
||
|
for sp in p:
|
||
|
# We've started a new subpath
|
||
|
# See if there is a prior subpath and whether we should keep it
|
||
|
if len( subpath_vertices ):
|
||
|
if distanceSquared( subpath_vertices[0], subpath_vertices[-1] ) < 1:
|
||
|
# Keep the prior subpath: it appears to be a closed path
|
||
|
subpaths.append( subpath_vertices )
|
||
|
subpath_vertices = []
|
||
|
subdivideCubicPath( sp, float( self.options.tolerance / 100 ) )
|
||
|
for csp in sp:
|
||
|
# Add this vertex to the list of vertices
|
||
|
subpath_vertices.append( csp[1] )
|
||
|
|
||
|
# Handle final subpath
|
||
|
if len( subpath_vertices ):
|
||
|
if distanceSquared( subpath_vertices[0], subpath_vertices[-1] ) < 1:
|
||
|
# Path appears to be closed so let's keep it
|
||
|
subpaths.append( subpath_vertices )
|
||
|
|
||
|
# Empty path?
|
||
|
if len( subpaths ) == 0:
|
||
|
return
|
||
|
|
||
|
# And add this path to our dictionary of paths
|
||
|
self.paths[node] = subpaths
|
||
|
|
||
|
# And save the transform for this element in a dictionary keyed
|
||
|
# by the element's lxml node pointer
|
||
|
self.transforms[node] = transform
|
||
|
|
||
|
def getBoundingBox( self ):
|
||
|
|
||
|
'''
|
||
|
Determine the bounding box for our collection of polygons
|
||
|
'''
|
||
|
|
||
|
self.xmin, self.xmax = EXTREME_POSITIVE_NUMBER, EXTREME_NEGATIVE_NUMBER
|
||
|
self.ymin, self.ymax = EXTREME_POSITIVE_NUMBER, EXTREME_NEGATIVE_NUMBER
|
||
|
for path in self.paths:
|
||
|
for subpath in self.paths[path]:
|
||
|
for vertex in subpath:
|
||
|
if vertex[0] < self.xmin:
|
||
|
self.xmin = vertex[0]
|
||
|
elif vertex[0] > self.xmax:
|
||
|
self.xmax = vertex[0]
|
||
|
if vertex[1] < self.ymin:
|
||
|
self.ymin = vertex[1]
|
||
|
elif vertex[1] > self.ymax:
|
||
|
self.ymax = vertex[1]
|
||
|
# for vertex in subpath:
|
||
|
# for subpath in self.paths[path]:
|
||
|
# for path in self.paths:
|
||
|
|
||
|
def recursivelyTraverseSvg( self, aNodeList,
|
||
|
matCurrent=[[1.0, 0.0, 0.0], [0.0, 1.0, 0.0]],
|
||
|
parent_visibility='visible' ):
|
||
|
'''
|
||
|
Recursively walk the SVG document, building polygon vertex lists
|
||
|
for each graphical element we support.
|
||
|
|
||
|
Rendered SVG elements:
|
||
|
<circle>, <ellipse>, <line>, <path>, <polygon>, <polyline>, <rect>
|
||
|
|
||
|
Supported SVG elements:
|
||
|
<group>, <use>
|
||
|
|
||
|
Ignored SVG elements:
|
||
|
<defs>, <eggbot>, <metadata>, <namedview>, <pattern>
|
||
|
|
||
|
All other SVG elements trigger an error (including <text>)
|
||
|
'''
|
||
|
for node in aNodeList:
|
||
|
# Ignore invisible nodes
|
||
|
v = node.get( 'visibility', parent_visibility )
|
||
|
if v == 'inherit':
|
||
|
v = parent_visibility
|
||
|
if v == 'hidden' or v == 'collapse':
|
||
|
pass
|
||
|
|
||
|
# first apply the current matrix transform to this node's tranform
|
||
|
matNew = simpletransform.composeTransform( matCurrent,
|
||
|
simpletransform.parseTransform( node.get( "transform" ) ) )
|
||
|
|
||
|
if node.tag == inkex.addNS( 'g', 'svg' ) or node.tag == 'g':
|
||
|
self.recursivelyTraverseSvg( node, matNew, parent_visibility=v )
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'use', 'svg' ) or node.tag == 'use':
|
||
|
|
||
|
# A <use> element refers to another SVG element via an xlink:href="#blah"
|
||
|
# attribute. We will handle the element by doing an XPath search through
|
||
|
# the document, looking for the element with the matching id="blah"
|
||
|
# attribute. We then recursively process that element after applying
|
||
|
# any necessary (x,y) translation.
|
||
|
#
|
||
|
# Notes:
|
||
|
# 1. We ignore the height and width attributes as they do not apply to
|
||
|
# path-like elements, and
|
||
|
# 2. Even if the use element has visibility="hidden", SVG still calls
|
||
|
# for processing the referenced element. The referenced element is
|
||
|
# hidden only if its visibility is "inherit" or "hidden".
|
||
|
|
||
|
refid = node.get( inkex.addNS( 'href', 'xlink' ) )
|
||
|
if not refid:
|
||
|
pass
|
||
|
|
||
|
# [1:] to ignore leading '#' in reference
|
||
|
path = '//*[@id="%s"]' % refid[1:]
|
||
|
refnode = node.xpath( path )
|
||
|
if refnode:
|
||
|
x = float( node.get( 'x', '0' ) )
|
||
|
y = float( node.get( 'y', '0' ) )
|
||
|
# Note: the transform has already been applied
|
||
|
if ( x != 0 ) or ( y != 0 ):
|
||
|
matNew2 = composeTransform( matNew, parseTransform( 'translate(%f,%f)' % (x,y) ) )
|
||
|
else:
|
||
|
matNew2 = matNew
|
||
|
v = node.get( 'visibility', v )
|
||
|
self.recursivelyTraverseSvg( refnode, matNew2, parent_visibility=v )
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'path', 'svg' ):
|
||
|
|
||
|
path_data = node.get( 'd')
|
||
|
if path_data:
|
||
|
self.addPathVertices( path_data, node, matNew )
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'rect', 'svg' ) or node.tag == 'rect':
|
||
|
|
||
|
# Manually transform
|
||
|
#
|
||
|
# <rect x="X" y="Y" width="W" height="H"/>
|
||
|
#
|
||
|
# into
|
||
|
#
|
||
|
# <path d="MX,Y lW,0 l0,H l-W,0 z"/>
|
||
|
#
|
||
|
# I.e., explicitly draw three sides of the rectangle and the
|
||
|
# fourth side implicitly
|
||
|
|
||
|
# Create a path with the outline of the rectangle
|
||
|
x = float( node.get( 'x' ) )
|
||
|
y = float( node.get( 'y' ) )
|
||
|
if ( not x ) or ( not y ):
|
||
|
pass
|
||
|
w = float( node.get( 'width', '0' ) )
|
||
|
h = float( node.get( 'height', '0' ) )
|
||
|
a = []
|
||
|
a.append( ['M ', [x, y]] )
|
||
|
a.append( [' l ', [w, 0]] )
|
||
|
a.append( [' l ', [0, h]] )
|
||
|
a.append( [' l ', [-w, 0]] )
|
||
|
a.append( [' Z', []] )
|
||
|
self.addPathVertices( simplepath.formatPath( a ), node, matNew )
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'line', 'svg' ) or node.tag == 'line':
|
||
|
|
||
|
# Convert
|
||
|
#
|
||
|
# <line x1="X1" y1="Y1" x2="X2" y2="Y2/>
|
||
|
#
|
||
|
# to
|
||
|
#
|
||
|
# <path d="MX1,Y1 LX2,Y2"/>
|
||
|
|
||
|
x1 = float( node.get( 'x1' ) )
|
||
|
y1 = float( node.get( 'y1' ) )
|
||
|
x2 = float( node.get( 'x2' ) )
|
||
|
y2 = float( node.get( 'y2' ) )
|
||
|
if ( not x1 ) or ( not y1 ) or ( not x2 ) or ( not y2 ):
|
||
|
pass
|
||
|
a = []
|
||
|
a.append( ['M ', [x1, y1]] )
|
||
|
a.append( [' L ', [x2, y2]] )
|
||
|
self.addPathVertices( simplepath.formatPath( a ), node, matNew )
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'polyline', 'svg' ) or node.tag == 'polyline':
|
||
|
|
||
|
# Convert
|
||
|
#
|
||
|
# <polyline points="x1,y1 x2,y2 x3,y3 [...]"/>
|
||
|
#
|
||
|
# to
|
||
|
#
|
||
|
# <path d="Mx1,y1 Lx2,y2 Lx3,y3 [...]"/>
|
||
|
#
|
||
|
# Note: we ignore polylines with no points
|
||
|
|
||
|
pl = node.get( 'points', '' ).strip()
|
||
|
if pl == '':
|
||
|
pass
|
||
|
|
||
|
pa = pl.split()
|
||
|
d = "".join( ["M " + pa[i] if i == 0 else " L " + pa[i] for i in range( 0, len( pa ) )] )
|
||
|
self.addPathVertices( d, node, matNew )
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'polygon', 'svg' ) or node.tag == 'polygon':
|
||
|
# Convert
|
||
|
#
|
||
|
# <polygon points="x1,y1 x2,y2 x3,y3 [...]"/>
|
||
|
#
|
||
|
# to
|
||
|
#
|
||
|
# <path d="Mx1,y1 Lx2,y2 Lx3,y3 [...] Z"/>
|
||
|
#
|
||
|
# Note: we ignore polygons with no points
|
||
|
|
||
|
pl = node.get( 'points', '' ).strip()
|
||
|
if pl == '':
|
||
|
pass
|
||
|
|
||
|
pa = pl.split()
|
||
|
d = "".join( ["M " + pa[i] if i == 0 else " L " + pa[i] for i in range( 0, len( pa ) )] )
|
||
|
d += " Z"
|
||
|
self.addPathVertices( d, node, matNew )
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'ellipse', 'svg' ) or \
|
||
|
node.tag == 'ellipse' or \
|
||
|
node.tag == inkex.addNS( 'circle', 'svg' ) or \
|
||
|
node.tag == 'circle':
|
||
|
|
||
|
# Convert circles and ellipses to a path with two 180 degree arcs.
|
||
|
# In general (an ellipse), we convert
|
||
|
#
|
||
|
# <ellipse rx="RX" ry="RY" cx="X" cy="Y"/>
|
||
|
#
|
||
|
# to
|
||
|
#
|
||
|
# <path d="MX1,CY A RX,RY 0 1 0 X2,CY A RX,RY 0 1 0 X1,CY"/>
|
||
|
#
|
||
|
# where
|
||
|
#
|
||
|
# X1 = CX - RX
|
||
|
# X2 = CX + RX
|
||
|
#
|
||
|
# Note: ellipses or circles with a radius attribute of value 0 are ignored
|
||
|
|
||
|
if node.tag == inkex.addNS( 'ellipse', 'svg' ) or node.tag == 'ellipse':
|
||
|
rx = float( node.get( 'rx', '0' ) )
|
||
|
ry = float( node.get( 'ry', '0' ) )
|
||
|
else:
|
||
|
rx = float( node.get( 'r', '0' ) )
|
||
|
ry = rx
|
||
|
if rx == 0 or ry == 0:
|
||
|
pass
|
||
|
|
||
|
cx = float( node.get( 'cx', '0' ) )
|
||
|
cy = float( node.get( 'cy', '0' ) )
|
||
|
x1 = cx - rx
|
||
|
x2 = cx + rx
|
||
|
d = 'M %f,%f ' % ( x1, cy ) + \
|
||
|
'A %f,%f ' % ( rx, ry ) + \
|
||
|
'0 1 0 %f,%f ' % ( x2, cy ) + \
|
||
|
'A %f,%f ' % ( rx, ry ) + \
|
||
|
'0 1 0 %f,%f' % ( x1, cy )
|
||
|
self.addPathVertices( d, node, matNew )
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'pattern', 'svg' ) or node.tag == 'pattern':
|
||
|
|
||
|
pass
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'metadata', 'svg' ) or node.tag == 'metadata':
|
||
|
|
||
|
pass
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'defs', 'svg' ) or node.tag == 'defs':
|
||
|
pass
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'namedview', 'sodipodi' ) or node.tag == 'namedview':
|
||
|
|
||
|
pass
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'eggbot', 'svg' ) or node.tag == 'eggbot':
|
||
|
|
||
|
pass
|
||
|
|
||
|
elif node.tag == inkex.addNS( 'text', 'svg' ) or node.tag == 'text':
|
||
|
|
||
|
inkex.errormsg( 'Warning: unable to draw text, please convert it to a path first.' )
|
||
|
|
||
|
pass
|
||
|
|
||
|
elif not isinstance( node.tag, basestring ):
|
||
|
|
||
|
pass
|
||
|
|
||
|
else:
|
||
|
|
||
|
inkex.errormsg( 'Warning: unable to draw object <%s>, please convert it to a path first.' % node.tag )
|
||
|
pass
|
||
|
# for node in aNodeList:
|
||
|
# def recursivelyTraverseSvg( self, aNodeList,...
|
||
|
|
||
|
def joinFillsWithNode ( self, node, stroke_width, path ):
|
||
|
|
||
|
'''
|
||
|
Generate a SVG <path> element containing the path data "path".
|
||
|
Then put this new <path> element into a <group> with the supplied
|
||
|
node. This means making a new <group> element and moving node
|
||
|
under it with the new <path> as a sibling element.
|
||
|
'''
|
||
|
|
||
|
if ( not path ) or ( len( path ) == 0 ):
|
||
|
return
|
||
|
|
||
|
# Make a new SVG <group> element whose parent is the parent of node
|
||
|
parent = node.getparent()
|
||
|
#was: if not parent:
|
||
|
if parent is None:
|
||
|
parent = self.document.getroot()
|
||
|
g = inkex.etree.SubElement( parent, inkex.addNS( 'g', 'svg' ) )
|
||
|
# Move node to be a child of this new <g> element
|
||
|
g.append( node )
|
||
|
|
||
|
# Now make a <path> element which contains the hatches & is a child
|
||
|
# of the new <g> element
|
||
|
stroke_color = '#000000' # default assumption
|
||
|
stroke_width = '1.0' # default value
|
||
|
|
||
|
try:
|
||
|
style = node.get('style')
|
||
|
if style != None:
|
||
|
declarations = style.split(';')
|
||
|
for i,declaration in enumerate(declarations):
|
||
|
parts = declaration.split(':', 2)
|
||
|
if len(parts) == 2:
|
||
|
(prop, val) = parts
|
||
|
prop = prop.strip().lower()
|
||
|
if prop == 'stroke-width':
|
||
|
stroke_width = val.strip()
|
||
|
elif prop == 'stroke':
|
||
|
val = val.strip()
|
||
|
stroke_color = val
|
||
|
# for i,declaration in enumerate(declarations):
|
||
|
# if style != 'none':
|
||
|
finally:
|
||
|
style = { 'stroke': '%s' % stroke_color, 'fill': 'none', 'stroke-width': '%s' % stroke_width }
|
||
|
line_attribs = { 'style':simplestyle.formatStyle( style ), 'd': path }
|
||
|
tran = node.get( 'transform' )
|
||
|
if ( tran != None ) and ( tran != '' ):
|
||
|
line_attribs['transform'] = tran
|
||
|
inkex.etree.SubElement( g, inkex.addNS( 'path', 'svg' ), line_attribs )
|
||
|
|
||
|
def makeHatchGrid( self, angle, spacing, init=True ): # returns True if succeeds in making grid, else False
|
||
|
|
||
|
'''
|
||
|
Build a grid of hatch lines which encompasses the entire bounding
|
||
|
box of the graphical elements we are to hatch.
|
||
|
|
||
|
1. Figure out the bounding box for all of the graphical elements
|
||
|
2. Pick a rectangle larger than that bounding box so that we can
|
||
|
later rotate the rectangle and still have it cover the bounding
|
||
|
box of the graphical elements.
|
||
|
3. Center the rectangle of 2 on the origin (0, 0).
|
||
|
4. Build the hatch line grid in this rectangle.
|
||
|
5. Rotate the rectangle by the hatch angle.
|
||
|
6. Translate the center of the rotated rectangle, (0, 0), to be
|
||
|
the center of the bounding box for the graphical elements.
|
||
|
7. We now have a grid of hatch lines which overlay the graphical
|
||
|
elements and can now be intersected with those graphical elements.
|
||
|
'''
|
||
|
|
||
|
# If this is the first call, do some one time initializations
|
||
|
# When generating cross hatches, we may be called more than once
|
||
|
if init:
|
||
|
self.getBoundingBox()
|
||
|
self.grid = []
|
||
|
|
||
|
# Determine the width and height of the bounding box containing
|
||
|
# all the polygons to be hatched
|
||
|
w = self.xmax - self.xmin
|
||
|
h = self.ymax - self.ymin
|
||
|
|
||
|
bBoundingBoxExists = ( ( w != ( EXTREME_NEGATIVE_NUMBER - EXTREME_POSITIVE_NUMBER ) ) and ( h != ( EXTREME_NEGATIVE_NUMBER - EXTREME_POSITIVE_NUMBER ) ) )
|
||
|
retValue = bBoundingBoxExists
|
||
|
|
||
|
if bBoundingBoxExists:
|
||
|
# Nice thing about rectangles is that the diameter of the circle
|
||
|
# encompassing them is the length the rectangle's diagonal...
|
||
|
r = math.sqrt ( w * w + h * h ) / 2.0
|
||
|
|
||
|
# Length of a hatch line will be 2r
|
||
|
# Now generate hatch lines within the square
|
||
|
# centered at (0, 0) and with side length at least d
|
||
|
|
||
|
# While we could generate these lines running back and forth,
|
||
|
# that makes for weird behavior later when applying odd/even
|
||
|
# rules AND there are nested polygons. Instead, when we
|
||
|
# generate the SVG <path> elements with the hatch line
|
||
|
# segments, we can do the back and forth weaving.
|
||
|
|
||
|
# Rotation information
|
||
|
ca = math.cos( math.radians( 90 - angle ) )
|
||
|
sa = math.sin( math.radians( 90 - angle ) )
|
||
|
|
||
|
# Translation information
|
||
|
cx = self.xmin + ( w / 2 )
|
||
|
cy = self.ymin + ( h / 2 )
|
||
|
|
||
|
# Since the spacing may be fractional (e.g., 6.5), we
|
||
|
# don't try to use range() or other integer iterator
|
||
|
spacing = float( abs( spacing ) )
|
||
|
i = -r
|
||
|
while i <= r:
|
||
|
# Line starts at (i, -r) and goes to (i, +r)
|
||
|
x1 = cx + ( i * ca ) + ( r * sa ) # i * ca - (-r) * sa
|
||
|
y1 = cy + ( i * sa ) - ( r * ca ) # i * sa + (-r) * ca
|
||
|
x2 = cx + ( i * ca ) - ( r * sa ) # i * ca - (+r) * sa
|
||
|
y2 = cy + ( i * sa ) + ( r * ca ) # i * sa + (+r) * ca
|
||
|
i += spacing
|
||
|
# Remove any potential hatch lines which are entirely
|
||
|
# outside of the bounding box
|
||
|
if (( x1 < self.xmin ) and ( x2 < self.xmin )) or \
|
||
|
(( x1 > self.xmax ) and ( x2 > self.xmax )):
|
||
|
continue
|
||
|
if (( y1 < self.ymin ) and ( y2 < self.ymin )) or \
|
||
|
(( y1 > self.ymax ) and ( y2 > self.ymax )):
|
||
|
continue
|
||
|
self.grid.append( ( x1, y1, x2, y2 ) )
|
||
|
# while i <= r:
|
||
|
# if bBoundingBoxExists:
|
||
|
return retValue
|
||
|
# def makeHatchGrid( self, angle, spacing, init=True ):
|
||
|
|
||
|
def effect( self ):
|
||
|
|
||
|
global referenceCount
|
||
|
global ptLastPositionAbsolute
|
||
|
# Viewbox handling
|
||
|
self.handleViewBox()
|
||
|
|
||
|
referenceCount = 0
|
||
|
ptLastPositionAbsolute = [0,0]
|
||
|
|
||
|
# Build a list of the vertices for the document's graphical elements
|
||
|
if self.options.ids:
|
||
|
# Traverse the selected objects
|
||
|
for id in self.options.ids:
|
||
|
self.recursivelyTraverseSvg( [self.selected[id]], self.docTransform )
|
||
|
else:
|
||
|
# Traverse the entire document
|
||
|
self.recursivelyTraverseSvg( self.document.getroot(), self.docTransform )
|
||
|
|
||
|
# Build a grid of possible hatch lines
|
||
|
bHaveGrid = self.makeHatchGrid( float( self.options.hatchAngle ),
|
||
|
float( self.options.hatchSpacing ), True )
|
||
|
# makeHatchGrid returns false if could not make grid - probably because bounding box is non-existent
|
||
|
if bHaveGrid:
|
||
|
if self.options.crossHatch:
|
||
|
self.makeHatchGrid( float( self.options.hatchAngle + 90.0 ),
|
||
|
float( self.options.hatchSpacing ), False )
|
||
|
# if self.options.crossHatch:
|
||
|
|
||
|
# Now loop over our hatch lines looking for intersections
|
||
|
for h in self.grid:
|
||
|
interstices( self, (h[0], h[1]), (h[2], h[3]), self.paths, self.hatches, self.options.holdBackHatchFromEdges, self.options.holdBackSteps )
|
||
|
|
||
|
# Target stroke width will be (doc width + doc height) / 2 / 1000
|
||
|
# stroke_width_target = ( self.docHeight + self.docWidth ) / 2000
|
||
|
# stroke_width_target = 1
|
||
|
stroke_width_target = 1
|
||
|
# Each hatch line stroke will be within an SVG object which may
|
||
|
# be subject to transforms. So, on an object by object basis,
|
||
|
# we need to transform our target width to a width suitable
|
||
|
# for that object (so that after the object and its hatches are
|
||
|
# transformed, the result has the desired width).
|
||
|
|
||
|
# To aid in the process, we use a diagonal line segment of length
|
||
|
# stroke_width_target. We then run this segment through an object's
|
||
|
# inverse transform and see what the resulting length of the inversely
|
||
|
# transformed segment is. We could, alternatively, look at the
|
||
|
# x and y scaling factors in the transform and average them.
|
||
|
s = stroke_width_target / math.sqrt( 2 )
|
||
|
|
||
|
# Now, dump the hatch fills sorted by which document element
|
||
|
# they correspond to. This is made easy by the fact that we
|
||
|
# saved the information and used each element's lxml.etree node
|
||
|
# pointer as the dictionary key under which to save the hatch
|
||
|
# fills for that node.
|
||
|
|
||
|
absoluteLineSegments = {}
|
||
|
nAbsoluteLineSegmentTotal = 0
|
||
|
nPenLifts = 0
|
||
|
# To implement
|
||
|
for key in self.hatches:
|
||
|
direction = True
|
||
|
if self.transforms.has_key( key ):
|
||
|
transform = inverseTransform( self.transforms[key] )
|
||
|
# Determine the scaled stroke width for a hatch line
|
||
|
# We produce a line segment of unit length, transform
|
||
|
# its endpoints and then determine the length of the
|
||
|
# resulting line segment.
|
||
|
pt1 = [0, 0]
|
||
|
pt2 = [s, s]
|
||
|
simpletransform.applyTransformToPoint( transform, pt1 )
|
||
|
simpletransform.applyTransformToPoint( transform, pt2 )
|
||
|
dx = pt2[0] - pt1[0]
|
||
|
dy = pt2[1] - pt1[1]
|
||
|
stroke_width = math.sqrt( dx * dx + dy * dy )
|
||
|
else:
|
||
|
transform = None
|
||
|
stroke_width = float( 1.0 )
|
||
|
|
||
|
# The transform also applies to the hatch spacing we use when searching for end connections
|
||
|
transformedHatchSpacing = stroke_width * self.options.hatchSpacing
|
||
|
|
||
|
path = '' # regardless of whether or not we're reducing pen lifts
|
||
|
ptLastPositionAbsolute = [ 0,0 ]
|
||
|
ptLastPositionAbsolute[0] = 0
|
||
|
ptLastPositionAbsolute[1] = 0
|
||
|
fDistanceMovedWithPenUp = 0
|
||
|
if not self.options.reducePenLifts:
|
||
|
for segment in self.hatches[key]:
|
||
|
if len( segment ) < 2:
|
||
|
continue
|
||
|
pt1 = segment[0]
|
||
|
pt2 = segment[1]
|
||
|
# Okay, we're going to put these hatch lines into the same
|
||
|
# group as the element they hatch. That element is down
|
||
|
# some chain of SVG elements, some of which may have
|
||
|
# transforms attached. But, our hatch lines have been
|
||
|
# computed assuming that those transforms have already
|
||
|
# been applied (since we had to apply them so as to know
|
||
|
# where this element is on the page relative to other
|
||
|
# elements and their transforms). So, we need to invert
|
||
|
# the transforms for this element and then either apply
|
||
|
# that inverse transform here and now or set it in a
|
||
|
# transform attribute of the <path> element. Having it
|
||
|
# set in the path element seems a bit counterintuitive
|
||
|
# after the fact (i.e., what's this tranform here for?).
|
||
|
# So, we compute the inverse transform and apply it here.
|
||
|
if transform != None:
|
||
|
simpletransform.applyTransformToPoint( transform, pt1 )
|
||
|
simpletransform.applyTransformToPoint( transform, pt2 )
|
||
|
# Now generate the path data for the <path>
|
||
|
if direction:
|
||
|
# Go this direction
|
||
|
path += ( 'M %f,%f l %f,%f ' %
|
||
|
( pt1[0], pt1[1], pt2[0] - pt1[0], pt2[1] - pt1[1] ) )
|
||
|
else:
|
||
|
# Or go this direction
|
||
|
path += ( 'M %f,%f l %f,%f ' %
|
||
|
( pt2[0], pt2[1], pt1[0] - pt2[0], pt1[1] - pt2[1] ) )
|
||
|
|
||
|
direction = not direction
|
||
|
# for segment in self.hatches[key]:
|
||
|
self.joinFillsWithNode( key, stroke_width, path[:-1] )
|
||
|
|
||
|
else: # if not self.options.reducePenLifts:
|
||
|
for segment in self.hatches[key]:
|
||
|
if len( segment ) < 2: # Copied from original, no idea why this is needed [sbm]
|
||
|
continue
|
||
|
if ( direction ):
|
||
|
pt1 = segment[0]
|
||
|
pt2 = segment[1]
|
||
|
else:
|
||
|
pt1 = segment[1]
|
||
|
pt2 = segment[0]
|
||
|
# Okay, we're going to put these hatch lines into the same
|
||
|
# group as the element they hatch. That element is down
|
||
|
# some chain of SVG elements, some of which may have
|
||
|
# transforms attached. But, our hatch lines have been
|
||
|
# computed assuming that those transforms have already
|
||
|
# been applied (since we had to apply them so as to know
|
||
|
# where this element is on the page relative to other
|
||
|
# elements and their transforms). So, we need to invert
|
||
|
# the transforms for this element and then either apply
|
||
|
# that inverse transform here and now or set it in a
|
||
|
# transform attribute of the <path> element. Having it
|
||
|
# set in the path element seems a bit counterintuitive
|
||
|
# after the fact (i.e., what's this tranform here for?).
|
||
|
# So, we compute the inverse transform and apply it here.
|
||
|
if transform != None:
|
||
|
simpletransform.applyTransformToPoint( transform, pt1 )
|
||
|
simpletransform.applyTransformToPoint( transform, pt2 )
|
||
|
|
||
|
# Now generate the path data for the <path>
|
||
|
# BUT we want to combine as many paths as possible to reduce pen lifts.
|
||
|
# In order to combine paths, we need to know all of the path segments.
|
||
|
# The solution to this conundrum is to generate all path segments,
|
||
|
# but instead of drawing them into the path right away, we put them in
|
||
|
# an array where they'll be available for random access
|
||
|
# by our anti-pen-lift algorithm
|
||
|
absoluteLineSegments[ nAbsoluteLineSegmentTotal ] = [ pt1, pt2, False ] # False indicates that segment has not yet been drawn
|
||
|
nAbsoluteLineSegmentTotal += 1
|
||
|
direction = not direction
|
||
|
# for segment in self.hatches[key]:
|
||
|
|
||
|
# Now have a nice juicy buffer full of line segments with absolute coordinates
|
||
|
fProposedNeighborhoodRadiusSquared = self.ProposeNeighborhoodRadiusSquared( transformedHatchSpacing ) # Just fixed and simple for now - may make function of neighborhood later
|
||
|
for referenceCount in range( nAbsoluteLineSegmentTotal ): # This is the entire range of segments,
|
||
|
# Sets global referenceCount to segment which has an end closest to current pen position.
|
||
|
# Doesn't need to select which end is closest, as that will happen below, with nReferenceEndIndex.
|
||
|
# When we have gone thru this whole range, we will be completely done.
|
||
|
# We only get here again, after all _connected_ segments have been "drawn".
|
||
|
if ( not absoluteLineSegments[referenceCount][2] ): # Test whether this segment has been drawn
|
||
|
# Has not been drawn yet
|
||
|
|
||
|
# Before we do any irrevocable changes to path, let's see if we are going to be able to append any segments.
|
||
|
# The below solution is inelegant, but has the virtue of being relatively simple to implement.
|
||
|
# Pre-qualify this segment on the issue of whether it has any connecting segments.
|
||
|
# If it does not, then just add the path for this one segment, and go on to the next.
|
||
|
# If it does have connecting segments, we need to go through the recursive logic.
|
||
|
# Lazily, again, select the desired direction of line ahead of time.
|
||
|
|
||
|
bFoundSegmentToAdd = False # default assumption
|
||
|
nReferenceEndIndexAtClosest = 0
|
||
|
nInnerCountAtClosest = -1
|
||
|
fClosestDistanceSquared = 123456 # just a random large number
|
||
|
for nReferenceEndIndex in range( 2 ):
|
||
|
ptReference = absoluteLineSegments[referenceCount][nReferenceEndIndex]
|
||
|
ptReferenceOtherEnd = absoluteLineSegments[referenceCount][not nReferenceEndIndex]
|
||
|
fReferenceDirectionRadians = math.atan2( ptReferenceOtherEnd[1] - ptReference[1], ptReferenceOtherEnd[0] - ptReference[0] ) # from other end to this end
|
||
|
# The following is just a simple copy from the routine in recursivelyAppendNearbySegmentIfAny procedure
|
||
|
# Look through all possibilities to choose the closest that fulfills all requirements e.g. direction and colinearity
|
||
|
for innerCount in range( nAbsoluteLineSegmentTotal ): # investigate all segments
|
||
|
if ( not absoluteLineSegments[innerCount][2] ):
|
||
|
# This segment currently undrawn, so it is a candidate for a path extension
|
||
|
# Need to check both ends of each and every proposed segment so we can find the most appropriate one
|
||
|
# Define pt2 in the reference as the end which we want to extend
|
||
|
for nNewSegmentInitialEndIndex in range( 2 ):
|
||
|
# First try initial end of test segment (aka pt1) vs final end (aka pt2) of reference segment
|
||
|
if ( innerCount != referenceCount ): # don't investigate self ends
|
||
|
deltaX = absoluteLineSegments[innerCount][nNewSegmentInitialEndIndex][0] - ptReference[0] # proposed initial pt1 X minus existing final pt1 X
|
||
|
deltaY = absoluteLineSegments[innerCount][nNewSegmentInitialEndIndex][1] - ptReference[1] # proposed initial pt1 Y minus existing final pt1 Y
|
||
|
if ( ( deltaX * deltaX + deltaY * deltaY ) < fProposedNeighborhoodRadiusSquared ):
|
||
|
fThisDistanceSquared = deltaX * deltaX + deltaY * deltaY
|
||
|
ptNewSegmentThisEnd = absoluteLineSegments[innerCount][nNewSegmentInitialEndIndex]
|
||
|
ptNewSegmentOtherEnd = absoluteLineSegments[innerCount][not nNewSegmentInitialEndIndex]
|
||
|
fNewSegmentDirectionRadians = math.atan2( ptNewSegmentThisEnd[1] - ptNewSegmentOtherEnd[1], ptNewSegmentThisEnd[0] - ptNewSegmentOtherEnd[0] ) # from other end to this end
|
||
|
# If this end would cause an alternating direction,
|
||
|
# then exclude it
|
||
|
if ( not self.WouldBeAnAlternatingDirection( fReferenceDirectionRadians, fNewSegmentDirectionRadians ) ):
|
||
|
pass
|
||
|
# break # out of for nNewSegmentInitialEndIndex in range( 2 ):
|
||
|
# if ( not self.WouldBeAnAlternatingDirection( fReferenceDirectionRadians, fNewSegmentDirectionRadians ) ):
|
||
|
elif ( fThisDistanceSquared < fClosestDistanceSquared ):
|
||
|
# One other thing could rule out choosing this segment end:
|
||
|
# Want to screen and remove two segments that, while close enough,
|
||
|
# should be disqualified because they are colinear. The reason for this is that
|
||
|
# if they are colinear, they arose from the same global grid line, which means
|
||
|
# that the gap between them arises from intersections with the boundary.
|
||
|
# The idea here is that, all things being more-or-less equal,
|
||
|
# we would like to give preference to connecting to a segment
|
||
|
# which is the reverse of our current direction. This makes for better
|
||
|
# bezier curve join.
|
||
|
# The criterion for being colinear is that the reference segment angle is effectively
|
||
|
# the same as the line connecting the reference segment to the end of the new segment.
|
||
|
fJoinerDirectionRadians = math.atan2( ptNewSegmentThisEnd[1] - ptReference[1], ptNewSegmentThisEnd[0] - ptReference[0] )
|
||
|
if ( not self.AreCoLinear( fReferenceDirectionRadians, fJoinerDirectionRadians) ):
|
||
|
# not colinear
|
||
|
fClosestDistanceSquared = fThisDistanceSquared
|
||
|
bFoundSegmentToAdd = True
|
||
|
nReferenceEndIndexAtClosest = nReferenceEndIndex
|
||
|
nInnerCountAtClosest = innerCount
|
||
|
deltaXAtClosest = deltaX
|
||
|
deltaYAtClosest = deltaY
|
||
|
# if ( not self.AreCoLinear( fReferenceDirectionRadians, fJoinerDirectionRadians) ):
|
||
|
# if ( fThisDistanceSquared < fClosestDistanceSquared ):
|
||
|
# if ( ( deltaX * deltaX + deltaY * deltaY ) < fProposedNeighborhoodRadiusSquared ):
|
||
|
# if ( innerCount != referenceCount ):
|
||
|
# for nNewSegmentInitialEndIndex in range( 2 ):
|
||
|
# if ( not absoluteLineSegments[2] ):
|
||
|
# for innerCount in range( nAbsoluteLineSegmentTotal ):
|
||
|
# for nReferenceEndIndex in range( 2 ):
|
||
|
|
||
|
# At last we've looked at all the candidate segment ends, as related to all the reference ends
|
||
|
if ( not bFoundSegmentToAdd ):
|
||
|
# This segment is solitary.
|
||
|
# Must start a new line, not joined to any previous paths
|
||
|
deltaX = absoluteLineSegments[referenceCount][1][0] - absoluteLineSegments[referenceCount][0][0] # end minus start, in original direction
|
||
|
deltaY = absoluteLineSegments[referenceCount][1][1] - absoluteLineSegments[referenceCount][0][1] # end minus start, in original direction
|
||
|
path += ( 'M %f,%f l %f,%f ' %
|
||
|
( absoluteLineSegments[referenceCount][0][0], absoluteLineSegments[referenceCount][0][1],
|
||
|
deltaX, deltaY ) ) # delta is from initial point
|
||
|
fDistanceMovedWithPenUp += math.hypot(
|
||
|
absoluteLineSegments[referenceCount][0][0] - ptLastPositionAbsolute[0],
|
||
|
absoluteLineSegments[referenceCount][0][1] - ptLastPositionAbsolute[1] )
|
||
|
ptLastPositionAbsolute[0] = absoluteLineSegments[referenceCount][0][0] + deltaX
|
||
|
ptLastPositionAbsolute[1] = absoluteLineSegments[referenceCount][0][1] + deltaY
|
||
|
absoluteLineSegments[ referenceCount ][2] = True # True flags that this line segment has been
|
||
|
# added to the path to be drawn, so should
|
||
|
# no longer be a candidate for any kind of move.
|
||
|
nPenLifts += 1
|
||
|
else: # if ( not bFoundSegmentToAdd ):
|
||
|
# Found segment to add, and we must get to it in absolute terms
|
||
|
deltaX = ( absoluteLineSegments[referenceCount][nReferenceEndIndexAtClosest][0] -
|
||
|
absoluteLineSegments[referenceCount][not nReferenceEndIndexAtClosest][0] )
|
||
|
# final point (which was closer to the closest continuation segment) minus initial point = deltaX
|
||
|
|
||
|
deltaY = ( absoluteLineSegments[referenceCount][nReferenceEndIndexAtClosest][1] -
|
||
|
absoluteLineSegments[referenceCount][not nReferenceEndIndexAtClosest][1] )
|
||
|
# final point (which was closer to the closest continuation segment) minus initial point = deltaY
|
||
|
|
||
|
path += ( 'M %f,%f l ' % (
|
||
|
absoluteLineSegments[referenceCount][ not nReferenceEndIndexAtClosest][0],
|
||
|
absoluteLineSegments[referenceCount][ not nReferenceEndIndexAtClosest][1] ) )
|
||
|
fDistanceMovedWithPenUp += math.hypot(
|
||
|
absoluteLineSegments[referenceCount][ not nReferenceEndIndexAtClosest][0] - ptLastPositionAbsolute[0],
|
||
|
absoluteLineSegments[referenceCount][ not nReferenceEndIndexAtClosest][1] - ptLastPositionAbsolute[1] )
|
||
|
ptLastPositionAbsolute[0] = absoluteLineSegments[referenceCount][ not nReferenceEndIndexAtClosest][0]
|
||
|
ptLastPositionAbsolute[1] = absoluteLineSegments[referenceCount][ not nReferenceEndIndexAtClosest][1]
|
||
|
# Note that this does not complete the line, as the completion (the deltaX, deltaY part) is being held in abeyance
|
||
|
|
||
|
# We are coming up on a problem:
|
||
|
# If we add a curve to the end of the line, we have made the curve extend beyond the end of the line,
|
||
|
# and thus beyond the boundaries we should be respecting.
|
||
|
# The solution is to hold in abeyance the actual plotting of the line,
|
||
|
# holding it available for shrinking if a curve is to be added.
|
||
|
# That is
|
||
|
relativePositionOfLastPlottedLineWasHeldInAbeyance = {}
|
||
|
relativePositionOfLastPlottedLineWasHeldInAbeyance[0] = deltaX # delta is from initial point
|
||
|
relativePositionOfLastPlottedLineWasHeldInAbeyance[1] = deltaY # Will be printed after we know if it must be modified
|
||
|
# to keep the ending join within bounds
|
||
|
ptLastPositionAbsolute[0] += deltaX
|
||
|
ptLastPositionAbsolute[1] += deltaY
|
||
|
|
||
|
absoluteLineSegments[ referenceCount ][2] = True # True flags that this line segment has been
|
||
|
# added to the path to be drawn, so should
|
||
|
# no longer be a candidate for any kind of move.
|
||
|
nPenLifts += 1
|
||
|
# Now comes the speedup logic:
|
||
|
# We've just drawn a segment starting at an absolute, not relative, position.
|
||
|
# It was drawn from pt1 to pt2.
|
||
|
# Look for an as-yet-not-drawn segment which has a beginning or ending
|
||
|
# point "near" the end point of this absolute draw, and leave the pen down
|
||
|
# while moving to and then drawing this found line.
|
||
|
# Do this recursively, marking each segment True to show that
|
||
|
# it has been "drawn" already.
|
||
|
# pt2 is the reference point, ie. the point from which the next segment will start
|
||
|
path = self.recursivelyAppendNearbySegmentIfAny(
|
||
|
transformedHatchSpacing,
|
||
|
0,
|
||
|
referenceCount,
|
||
|
nReferenceEndIndexAtClosest,
|
||
|
nAbsoluteLineSegmentTotal,
|
||
|
absoluteLineSegments,
|
||
|
path,
|
||
|
relativePositionOfLastPlottedLineWasHeldInAbeyance )
|
||
|
# if ( not bFoundSegmentToAdd ): else:
|
||
|
# if ( not absoluteLineSegments[referenceCount][2] ):
|
||
|
# while ( self.IndexOfNearestSegmentToLastPosition() ):
|
||
|
self.joinFillsWithNode( key, stroke_width, path[:-1] )
|
||
|
# if not self.options.reducePenLifts: else:
|
||
|
# for key in self.hatches:
|
||
|
|
||
|
'''
|
||
|
if self.options.reducePenLifts:
|
||
|
if ( nAbsoluteLineSegmentTotal != 0 ):
|
||
|
inkex.errormsg( ' Saved %i%% of %i pen lifts.' % ( 100 * ( nAbsoluteLineSegmentTotal - nPenLifts ) / nAbsoluteLineSegmentTotal, nAbsoluteLineSegmentTotal ) )
|
||
|
inkex.errormsg( ' pen lifts=%i, line segments=%i' % ( nPenLifts, nAbsoluteLineSegmentTotal ) )
|
||
|
else:
|
||
|
inkex.errormsg( ' No lines were plotted' )
|
||
|
|
||
|
inkex.errormsg( ' Press OK' )
|
||
|
# if self.options.reducePenLifts:
|
||
|
#inkex.errormsg("Elapsed CPU time was %f" % (time.clock()-self.t0))
|
||
|
'''
|
||
|
else: # if bHaveGrid:
|
||
|
inkex.errormsg( ' Nothing to plot' )
|
||
|
# if bHaveGrid: else:
|
||
|
# def effect( self ):
|
||
|
|
||
|
def recursivelyAppendNearbySegmentIfAny(
|
||
|
self,
|
||
|
transformedHatchSpacing,
|
||
|
nRecursionCount,
|
||
|
nReferenceSegmentCount,
|
||
|
nReferenceEndIndex,
|
||
|
nAbsoluteLineSegmentTotal,
|
||
|
absoluteLineSegments,
|
||
|
cumulativePath,
|
||
|
relativePositionOfLastPlottedLineWasHeldInAbeyance ):
|
||
|
|
||
|
global ptLastPositionAbsolute
|
||
|
fProposedNeighborhoodRadiusSquared = self.ProposeNeighborhoodRadiusSquared( transformedHatchSpacing )
|
||
|
|
||
|
# Look through all possibilities to choose the closest
|
||
|
bFoundSegmentToAdd = False # default assumption
|
||
|
nNewSegmentInitialEndIndexAtClosest = 0
|
||
|
nOuterCountAtClosest = -1
|
||
|
fClosestDistanceSquared = 123456789.0 # just a random large number
|
||
|
|
||
|
ptReference = absoluteLineSegments[nReferenceSegmentCount][nReferenceEndIndex]
|
||
|
ptReferenceOtherEnd = absoluteLineSegments[nReferenceSegmentCount][not nReferenceEndIndex]
|
||
|
fReferenceDeltaX = ptReferenceOtherEnd[0] - ptReference[0]
|
||
|
fReferenceDeltaY = ptReferenceOtherEnd[1] - ptReference[1]
|
||
|
fReferenceDirectionRadians = math.atan2( fReferenceDeltaY, fReferenceDeltaX ) # from other end to this end
|
||
|
|
||
|
for outerCount in range( nAbsoluteLineSegmentTotal ): # investigate all segments
|
||
|
if ( not absoluteLineSegments[outerCount][2] ):
|
||
|
# This segment currently undrawn, so it is a candidate for a path extension
|
||
|
|
||
|
# Need to check both ends of each and every proposed segment until we find one in the neighborhood
|
||
|
# Defines pt2 in the reference as the end which we want to extend
|
||
|
|
||
|
for nNewSegmentInitialEndIndex in range( 2 ):
|
||
|
# First try initial end of test segment (aka pt1) vs final end (aka pt2) of reference segment
|
||
|
if ( outerCount != nReferenceSegmentCount ): # don't investigate self ends
|
||
|
deltaX = absoluteLineSegments[outerCount][nNewSegmentInitialEndIndex][0] - ptReference[0] # proposed initial pt1 X minus existing final pt1 X
|
||
|
deltaY = absoluteLineSegments[outerCount][nNewSegmentInitialEndIndex][1] - ptReference[1] # proposed initial pt1 Y minus existing final pt1 Y
|
||
|
if ( ( deltaX * deltaX + deltaY * deltaY ) < fProposedNeighborhoodRadiusSquared ):
|
||
|
fThisDistanceSquared = deltaX * deltaX + deltaY * deltaY
|
||
|
ptNewSegmentThisEnd = absoluteLineSegments[outerCount][nNewSegmentInitialEndIndex]
|
||
|
ptNewSegmentOtherEnd = absoluteLineSegments[outerCount][not nNewSegmentInitialEndIndex]
|
||
|
fNewSegmentDeltaX = ptNewSegmentThisEnd[0] - ptNewSegmentOtherEnd[0]
|
||
|
fNewSegmentDeltaY = ptNewSegmentThisEnd[1] - ptNewSegmentOtherEnd[1]
|
||
|
fNewSegmentDirectionRadians = math.atan2( fNewSegmentDeltaY, fNewSegmentDeltaX ) # from other end to this end
|
||
|
if ( not self.WouldBeAnAlternatingDirection( fReferenceDirectionRadians, fNewSegmentDirectionRadians ) ):
|
||
|
# If this end would cause an alternating direction,
|
||
|
# then exclude it regardless of how close it is
|
||
|
pass
|
||
|
# if ( not self.WouldBeAnAlternatingDirection( fReferenceDirectionRadians, fNewSegmentDirectionRadians ) ):
|
||
|
|
||
|
elif ( fThisDistanceSquared < fClosestDistanceSquared ):
|
||
|
# One other thing could rule out choosing this segment end:
|
||
|
# Want to screen and remove two segments that, while close enough,
|
||
|
# should be disqualified because they are colinear. The reason for this is that
|
||
|
# if they are colinear, they arose from the same global grid line, which means
|
||
|
# that the gap between them arises from intersections with the boundary.
|
||
|
# The idea here is that, all things being more-or-less equal,
|
||
|
# we would like to give preference to connecting to a segment
|
||
|
# which is the reverse of our current direction. This makes for better
|
||
|
# bezier curve join.
|
||
|
# The criterion for being colinear is that the reference segment angle is effectively
|
||
|
# the same as the line connecting the reference segment to the end of the new segment.
|
||
|
|
||
|
fJoinerDirectionRadians = math.atan2( ptNewSegmentThisEnd[1] - ptReference[1], ptNewSegmentThisEnd[0] - ptReference[0] )
|
||
|
if ( not self.AreCoLinear( fReferenceDirectionRadians, fJoinerDirectionRadians) ):
|
||
|
# not colinear
|
||
|
fClosestDistanceSquared = fThisDistanceSquared
|
||
|
bFoundSegmentToAdd = True
|
||
|
nNewSegmentInitialEndIndexAtClosest = nNewSegmentInitialEndIndex
|
||
|
nOuterCountAtClosest = outerCount
|
||
|
deltaXAtClosest = deltaX
|
||
|
deltaYAtClosest = deltaY
|
||
|
# if ( not self.AreCoLinear( fReferenceDirectionRadians, fJoinerDirectionRadians) ):
|
||
|
# if ( not self.WouldBeAnAlternatingDirection( fReferenceDirectionRadians, fNewSegmentDirectionRadians ) ): elif ( fThisDistanceSquared < fClosestDistanceSquared ):
|
||
|
# if ( ( deltaX * deltaX + deltaY * deltaY ) < fProposedNeighborhoodRadiusSquared ):
|
||
|
# if ( outerCount != nReferenceSegmentCount ):
|
||
|
# for nNewSegmentInitialEndIndex in range( 2 ):
|
||
|
# if ( not absoluteLineSegments[2] ):
|
||
|
# for outerCount in range( nAbsoluteLineSegmentTotal ):
|
||
|
|
||
|
# At last we've looked at all the candidate segment ends
|
||
|
nRecursionCount += 1
|
||
|
if ( ( not bFoundSegmentToAdd ) or ( ( nRecursionCount >= RECURSION_LIMIT ) ) ):
|
||
|
cumulativePath += '%f,%f ' % ( relativePositionOfLastPlottedLineWasHeldInAbeyance[0], relativePositionOfLastPlottedLineWasHeldInAbeyance[1] ) # close out this segment
|
||
|
ptLastPositionAbsolute[0] += relativePositionOfLastPlottedLineWasHeldInAbeyance[0]
|
||
|
ptLastPositionAbsolute[1] += relativePositionOfLastPlottedLineWasHeldInAbeyance[1]
|
||
|
return cumulativePath # No undrawn segments were suitable for appending,
|
||
|
# or there were so many that we worry about python recursion limit
|
||
|
else: # if ( not bFoundSegmentToAdd ):
|
||
|
nNewSegmentInitialEndIndex = nNewSegmentInitialEndIndexAtClosest
|
||
|
nNewSegmentFinalEndIndex = not nNewSegmentInitialEndIndex
|
||
|
# nNewSegmentInitialEndIndex is 0 for connecting to pt1,
|
||
|
# and is 1 for connecting to pt2
|
||
|
count = nOuterCountAtClosest # count is the index of the segment to be appended.
|
||
|
deltaX = deltaXAtClosest # delta from final end of incoming segment to initial end of outgoing segment
|
||
|
deltaY = deltaYAtClosest
|
||
|
|
||
|
# First, move pen to initial end (may be either its pt1 or its pt2) of new segment
|
||
|
|
||
|
# Insert a bezier curve for this transition element
|
||
|
# To accomplish this, we need information on the incoming and outgoing segments.
|
||
|
# Specifically, we need to know the lengths and angles of the segments in
|
||
|
# order to decide on control points.
|
||
|
fIncomingDeltaX = absoluteLineSegments[nReferenceSegmentCount][nReferenceEndIndex][0] - absoluteLineSegments[nReferenceSegmentCount][not nReferenceEndIndex][0]
|
||
|
fIncomingDeltaY = absoluteLineSegments[nReferenceSegmentCount][nReferenceEndIndex][1] - absoluteLineSegments[nReferenceSegmentCount][not nReferenceEndIndex][1]
|
||
|
# The outgoing deltas are based on the reverse direction of the segment, i.e. the segment pointing back to the joiner bezier curve
|
||
|
fOutgoingDeltaX = absoluteLineSegments[count][nNewSegmentInitialEndIndex][0] - absoluteLineSegments[count][nNewSegmentFinalEndIndex][0] # index is [count][start point = 0, final point = 1][0=x, 1=y]
|
||
|
fOutgoingDeltaY = absoluteLineSegments[count][nNewSegmentInitialEndIndex][1] - absoluteLineSegments[count][nNewSegmentFinalEndIndex][1]
|
||
|
|
||
|
lengthOfIncoming = math.hypot( fIncomingDeltaX, fIncomingDeltaY )
|
||
|
lengthOfOutgoing = math.hypot( fOutgoingDeltaX, fOutgoingDeltaY )
|
||
|
|
||
|
# We are going to trim-up the ends of the incoming and outgoing segments,
|
||
|
# in order to get a curve which reliably does not extend beyond the boundary.
|
||
|
# Crude readings from inkscape on bezier curve overshoot, using control points extended hatch-spacing distance parallel to segment:
|
||
|
# when end points are in line, overshoot 12/16 in direction of segment
|
||
|
# when at 45 degrees, overshoot 12/16 in direction of segment
|
||
|
# when at 60 degrees, overshoot 12/16 in direction of segment
|
||
|
# Conclusion, at any angle, remove 0.75 * hatch spacing from the length of both lines,
|
||
|
# where 0.75 is, by no coincidence, BEZIER_OVERSHOOT_MULTIPLIER
|
||
|
|
||
|
# If hatches are getting quite short, we can use a smaller Bezier loop at
|
||
|
# the end to squeeze into smaller spaces. We'll use a normal nice smooth
|
||
|
# curve for non-short hatches
|
||
|
fDesiredShortenForSmoothestJoin = transformedHatchSpacing * BEZIER_OVERSHOOT_MULTIPLIER # This is what we really want to use for smooth curves
|
||
|
# Separately check incoming vs outgoing lengths to see if bezier distances must be reduced,
|
||
|
# then choose greatest reduction to apply to both - lest we go off-course
|
||
|
# Finally, clip reduction to be no less than 1.0
|
||
|
fControlPointDividerIncoming = 2.0 * fDesiredShortenForSmoothestJoin / lengthOfIncoming
|
||
|
fControlPointDividerOutgoing = 2.0 * fDesiredShortenForSmoothestJoin / lengthOfOutgoing
|
||
|
if ( fControlPointDividerIncoming > fControlPointDividerOutgoing ):
|
||
|
fLargestDesiredControlPointDivider = fControlPointDividerIncoming
|
||
|
else: # if ( fControlPointDividerIncoming > fControlPointDividerOutgoing ):
|
||
|
fLargestDesiredControlPointDivider = fControlPointDividerOutgoing
|
||
|
# if ( fControlPointDividerIncoming > fControlPointDividerOutgoing ): else:
|
||
|
if (fLargestDesiredControlPointDivider < 1.0):
|
||
|
fControlPointDivider = 1.0
|
||
|
else: # if (fLargestDesiredControlPointDivider < 1.0):
|
||
|
fControlPointDivider = fLargestDesiredControlPointDivider
|
||
|
# if (fLargestDesiredControlPointDivider < 1.0): else:
|
||
|
fDesiredShorten = fDesiredShortenForSmoothestJoin / fControlPointDivider
|
||
|
|
||
|
ptDeltaToSubtractFromIncomingEnd = self.RelativeControlPointPosition( fDesiredShorten, fIncomingDeltaX, fIncomingDeltaY, 0, 0 )
|
||
|
# Note that this will be subtracted from the _point held in abeyance_.
|
||
|
relativePositionOfLastPlottedLineWasHeldInAbeyance[0] -= ptDeltaToSubtractFromIncomingEnd[0]
|
||
|
relativePositionOfLastPlottedLineWasHeldInAbeyance[1] -= ptDeltaToSubtractFromIncomingEnd[1]
|
||
|
|
||
|
ptDeltaToAddToOutgoingStart = self.RelativeControlPointPosition( fDesiredShorten, fOutgoingDeltaX, fOutgoingDeltaY, 0, 0 )
|
||
|
|
||
|
# We know that when we tack on a curve, we must chop some off the end of the incoming segment,
|
||
|
# and also chop some off the start of the outgoing segment.
|
||
|
# Now, we know we want the control points to be on a projection of each segment,
|
||
|
# in order that there be no abrupt change of plotting angle. The question is, how
|
||
|
# far beyond the endpoint should we place the control point.
|
||
|
ptRelativeControlPointIncoming = self.RelativeControlPointPosition(
|
||
|
transformedHatchSpacing / fControlPointDivider,
|
||
|
fIncomingDeltaX,
|
||
|
fIncomingDeltaY,
|
||
|
0,
|
||
|
0 )
|
||
|
ptRelativeControlPointOutgoing = self.RelativeControlPointPosition(
|
||
|
transformedHatchSpacing / fControlPointDivider,
|
||
|
fOutgoingDeltaX,
|
||
|
fOutgoingDeltaY,
|
||
|
deltaX,
|
||
|
deltaY)
|
||
|
|
||
|
cumulativePath += '%f,%f ' % ( relativePositionOfLastPlottedLineWasHeldInAbeyance[0], relativePositionOfLastPlottedLineWasHeldInAbeyance[1] ) # close out this segment, which has been modified
|
||
|
ptLastPositionAbsolute[0] += relativePositionOfLastPlottedLineWasHeldInAbeyance[0]
|
||
|
ptLastPositionAbsolute[1] += relativePositionOfLastPlottedLineWasHeldInAbeyance[1]
|
||
|
# add bezier cubic curve
|
||
|
cumulativePath += ( 'c %f,%f %f,%f %f,%f l ' %
|
||
|
( ptRelativeControlPointIncoming[0],
|
||
|
ptRelativeControlPointIncoming[1],
|
||
|
ptRelativeControlPointOutgoing[0],
|
||
|
ptRelativeControlPointOutgoing[1],
|
||
|
deltaX,
|
||
|
deltaY ) )
|
||
|
ptLastPositionAbsolute[0] += deltaX
|
||
|
ptLastPositionAbsolute[1] += deltaY
|
||
|
# Next, move pen in appropriate direction to draw the new segment, given that
|
||
|
# we have just moved to the initial end of the new segment.
|
||
|
# This needs special treatment, as we just did some length changing.
|
||
|
deltaX = absoluteLineSegments[count][nNewSegmentFinalEndIndex][0] - absoluteLineSegments[count][nNewSegmentInitialEndIndex][0] + ptDeltaToAddToOutgoingStart[0]
|
||
|
deltaY = absoluteLineSegments[count][nNewSegmentFinalEndIndex][1] - absoluteLineSegments[count][nNewSegmentInitialEndIndex][1] + ptDeltaToAddToOutgoingStart[1]
|
||
|
relativePositionOfLastPlottedLineWasHeldInAbeyance[0] = deltaX # delta is from initial point
|
||
|
relativePositionOfLastPlottedLineWasHeldInAbeyance[1] = deltaY # Will be printed after we know if it must be modified
|
||
|
|
||
|
# Mark this segment as drawn
|
||
|
absoluteLineSegments[count][2] = True
|
||
|
|
||
|
cumulativePath = self.recursivelyAppendNearbySegmentIfAny( transformedHatchSpacing, nRecursionCount, count, nNewSegmentFinalEndIndex, nAbsoluteLineSegmentTotal, absoluteLineSegments, cumulativePath, relativePositionOfLastPlottedLineWasHeldInAbeyance )
|
||
|
return cumulativePath
|
||
|
# if ( not bFoundSegmentToAdd ): else:
|
||
|
# def recursivelyAppendNearbySegmentIfAny( ... ):
|
||
|
|
||
|
def ProposeNeighborhoodRadiusSquared( self, transformedHatchSpacing ):
|
||
|
return transformedHatchSpacing * transformedHatchSpacing * self.options.hatchScope * self.options.hatchScope
|
||
|
# The multiplier of x generates a radius of x^0.5 times the hatch spacing.
|
||
|
|
||
|
def RelativeControlPointPosition( self, distance, fDeltaX, fDeltaY, deltaX, deltaY ):
|
||
|
|
||
|
# returns the point, relative to 0, 0 offset by deltaX, deltaY,
|
||
|
# which extends a distance of "distance" at a slope defined by fDeltaX and fDeltaY
|
||
|
ptReturn = [0, 0]
|
||
|
|
||
|
if ( fDeltaX == 0 ):
|
||
|
ptReturn[0] = deltaX
|
||
|
ptReturn[1] = math.copysign( distance, fDeltaY ) + deltaY
|
||
|
elif ( fDeltaY == 0 ):
|
||
|
ptReturn[0] = math.copysign( distance, fDeltaX ) + deltaX
|
||
|
ptReturn[1] = deltaY
|
||
|
else:
|
||
|
fSlope = math.atan2( fDeltaY, fDeltaX )
|
||
|
ptReturn[0] = distance * math.cos( fSlope ) + deltaX
|
||
|
ptReturn[1] = distance * math.sin( fSlope ) + deltaY
|
||
|
|
||
|
return ptReturn
|
||
|
|
||
|
def WouldBeAnAlternatingDirection( self, fReferenceDirectionRadians, fNewSegmentDirectionRadians ):
|
||
|
# atan2 returns values in the range -pi to +pi, so we must evaluate difference values
|
||
|
# in the range of -2*pi to +2*pi
|
||
|
fDirectionDifferenceRadians = fReferenceDirectionRadians - fNewSegmentDirectionRadians
|
||
|
if ( fDirectionDifferenceRadians < 0 ):
|
||
|
fDirectionDifferenceRadians += 2 * math.pi
|
||
|
# Without having changed the vector direction of the difference, we have
|
||
|
# now reduced the range to 0 to 2*pi
|
||
|
fDirectionDifferenceRadians -= math.pi # flip opposite direction to coincide with same direction
|
||
|
# Of course they may not be _exactly_ pi different due to osmosis, so allow a tolerance
|
||
|
bRetVal = ( abs(fDirectionDifferenceRadians) < RADIAN_TOLERANCE_FOR_ALTERNATING_DIRECTION )
|
||
|
|
||
|
return bRetVal
|
||
|
|
||
|
def AreCoLinear( self, fDirection1Radians, fDirection2Radians ):
|
||
|
# allow slight difference in angles, for floating-point indeterminacy
|
||
|
fAbsDeltaRadians = abs( fDirection1Radians - fDirection2Radians )
|
||
|
if ( ( fAbsDeltaRadians < RADIAN_TOLERANCE_FOR_COLINEAR ) ):
|
||
|
return True
|
||
|
elif ( ( abs( fAbsDeltaRadians - math.pi ) < RADIAN_TOLERANCE_FOR_COLINEAR ) ):
|
||
|
return True
|
||
|
else:
|
||
|
return False
|
||
|
|
||
|
if __name__ == '__main__':
|
||
|
|
||
|
e = Eggbot_Hatch()
|
||
|
e.affect()
|