nic/drawing-robot-ros2
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Account for redundant points with z > 0

Browse Source
This commit is contained in:
Nicolas Hiillos
2023-03-02 17:24:01 +02:00
parent f17dd45a99
commit aece2ac7b6
1 changed files with 11 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files

7
src/drawing_controller/drawing_controller/svg_processor.py
View File

@@ -343,15 +343,16 @@ class SVGProcessor():
tolerance = 0.001 tolerance = 0.001
prev = (-1, -1, 0) prev = (-1, -1, 0)
for i, p in enumerate(motion): for i, p in enumerate(motion):
next = motion[(i + 1) % len(motion)]
if (p[2] <= 0):
x = p[0] x = p[0]
y = p[1] y = p[1]
z = p[2]
px = prev[0] px = prev[0]
py = prev[1] py = prev[1]
pz = prev[2]
xdiff = abs(x - px) xdiff = abs(x - px)
ydiff = abs(y - py) ydiff = abs(y - py)
if xdiff < tolerance and ydiff < tolerance and next[2] <= 0: zdiff = abs(z - pz)
if xdiff < tolerance and ydiff < tolerance and zdiff < tolerance:
continue continue
prev = p prev = p
mm.append(p) mm.append(p)