Correct coordinates

This commit is contained in:
2023-01-17 11:54:11 +02:00
parent ed023558aa
commit c2ee6e6d0e

View File

@@ -126,10 +126,10 @@ class DrawingController(Node):
p1 = self.map_point(next_line[0][0],next_line[0][1])
p2 = self.map_point(next_line[1][0],next_line[1][1])
self.get_logger().info('Drawing line with p1:{} p2:{}'.format(p1,p2))
self.append_point(motion, p1, 0.2)
self.append_point(motion, p1, 0.1)
self.append_point(motion, p2, 0.1)
self.append_point(motion, p2, 0.2)
self.append_point(motion, p1, 1.0)
self.append_point(motion, p1, 0.0)
self.append_point(motion, p2, 0.0)
self.append_point(motion, p2, 1.0)
self.i = (self.i + 1) % len(self.lines)
self.get_logger().info('Executing motion:{}'.format(motion.path))