Enlarge arc triangle detection

This commit is contained in:
2024-06-22 17:34:53 +02:00
parent ebf3a604f0
commit 8a10b5f568
4 changed files with 56 additions and 18 deletions

View File

@@ -106,10 +106,13 @@ def main():
# place_segment(Segment2D(Point2D(147, -616), Point2D(201, -595))) # place_segment(Segment2D(Point2D(147, -616), Point2D(201, -595)))
# place_segment(Segment2D(Point2D(147, -616), Point2D(233, -605))) # place_segment(Segment2D(Point2D(147, -616), Point2D(233, -605)))
y = 120 # y = 120
Road([Point3D(121, 108+y, -68), Point3D(163, 108+y, -95), Point3D(173, 108+y, -169), Point3D(188, 108+y, -174), Point3D(229, # Road([Point3D(-46, 64, -12), Point3D(-86, 65, 13), Point3D(-47, 66, 82),
108+y, -217), Point3D(190, 95+y, -270), Point3D(198, 95+y, -297), Point3D(237, 95+y, -287), Point3D(283, 95+y, -328)], 15) # Point3D(-117, 69, 150), Point3D(-149, 68, 148), Point3D(-185, 70, 78)], 9)
Road([Point3D(-130, 70, 7), Point3D(-170, 67, -9), Point3D(-189, 79, 3), Point3D(-194,
82, 25), Point3D(-217, 88, 30), Point3D(-248, 89, 20), Point3D(-212, 98, 12)], 9)
# Road([Point3D(464, 85+10, -225), Point3D(408, 105+10, -224), # Road([Point3D(464, 85+10, -225), Point3D(408, 105+10, -224),
# Point3D(368, 104+10, -249), Point3D(368, 85+10, -296), Point3D(457, 79+10, -292)], 15) # Point3D(368, 104+10, -249), Point3D(368, 85+10, -296), Point3D(457, 79+10, -292)], 15)

View File

@@ -134,9 +134,9 @@ class Polyline:
points = Circle(self.centers[i]).circle(self.radii[i]) points = Circle(self.centers[i]).circle(self.radii[i])
# Better to do here than drawing circle arc inside big triangle! # Better to do here than drawing circle arc inside big triangle!
double_point_a = Point2D.from_arrays(Point2D.to_arrays(self.acrs_intersections[i][0]) + 5 * (Point2D.to_arrays( double_point_a = Point2D.from_arrays(Point2D.to_arrays(self.acrs_intersections[i][0]) + 50 * (Point2D.to_arrays(
self.acrs_intersections[i][0]) - Point2D.to_arrays(self.centers[i]))) self.acrs_intersections[i][0]) - Point2D.to_arrays(self.centers[i])))
double_point_b = Point2D.from_arrays(Point2D.to_arrays(self.acrs_intersections[i][2]) + 5 * (Point2D.to_arrays( double_point_b = Point2D.from_arrays(Point2D.to_arrays(self.acrs_intersections[i][2]) + 50 * (Point2D.to_arrays(
self.acrs_intersections[i][2]) - Point2D.to_arrays(self.centers[i]))) self.acrs_intersections[i][2]) - Point2D.to_arrays(self.centers[i])))
for j in range(len(points)): for j in range(len(points)):

View File

@@ -9,6 +9,8 @@ from networks.geometry.Segment3D import Segment3D
from networks.geometry.Circle import Circle from networks.geometry.Circle import Circle
from utils.Enums import LINE_THICKNESS_MODE from utils.Enums import LINE_THICKNESS_MODE
from gdpc import Block, Editor, geometry from gdpc import Block, Editor, geometry
from scipy.ndimage import gaussian_filter1d
import numpy as np
class Road: class Road:
@@ -29,7 +31,7 @@ class Road:
self.polyline_total_line_output = [ self.polyline_total_line_output = [
[] for _ in range(len(self.polyline.total_line_output))] [] for _ in range(len(self.polyline.total_line_output))]
self._projection_polyline() self._projection_gaussian()
if len(self.coordinates) == 2: if len(self.coordinates) == 2:
self.segment_total_line_output = Segment2D( self.segment_total_line_output = Segment2D(
@@ -101,21 +103,22 @@ class Road:
(self.polyline.radii[i]-self.width/2))+1, int((self.polyline.radii[i]+self.width/2))+1) (self.polyline.radii[i]-self.width/2))+1, int((self.polyline.radii[i]+self.width/2))+1)
# Better to do here than drawing circle arc inside big triangle! # Better to do here than drawing circle arc inside big triangle!
double_point_a = Point2D.from_arrays(Point2D.to_arrays(self.polyline.acrs_intersections[i][0]) + 5 * (Point2D.to_arrays( double_point_a = Point2D.from_arrays(Point2D.to_arrays(self.polyline.acrs_intersections[i][0]) + 50 * (Point2D.to_arrays(
self.polyline.acrs_intersections[i][0]) - Point2D.to_arrays(self.polyline.centers[i]))) self.polyline.acrs_intersections[i][0]) - Point2D.to_arrays(self.polyline.centers[i])))
double_point_b = Point2D.from_arrays(Point2D.to_arrays(self.polyline.acrs_intersections[i][2]) + 5 * (Point2D.to_arrays( double_point_b = Point2D.from_arrays(Point2D.to_arrays(self.polyline.acrs_intersections[i][2]) + 50 * (Point2D.to_arrays(
self.polyline.acrs_intersections[i][2]) - Point2D.to_arrays(self.polyline.centers[i]))) self.polyline.acrs_intersections[i][2]) - Point2D.to_arrays(self.polyline.centers[i])))
editor = Editor(buffering=True) # Debug
editor.placeBlock(Point3D.insert_3d( # editor = Editor(buffering=True)
[self.polyline.acrs_intersections[i][0]], 'y', [230])[0].coordinates, Block("purple_concrete")) # editor.placeBlock(Point3D.insert_3d(
editor.placeBlock(Point3D.insert_3d( # [self.polyline.acrs_intersections[i][0]], 'y', [230])[0].coordinates, Block("purple_concrete"))
[self.polyline.acrs_intersections[i][2]], 'y', [230])[0].coordinates, Block("pink_concrete")) # editor.placeBlock(Point3D.insert_3d(
# [self.polyline.acrs_intersections[i][2]], 'y', [230])[0].coordinates, Block("pink_concrete"))
geometry.placeLine(editor, Point3D.insert_3d([double_point_a], 'y', [229])[ # geometry.placeLine(editor, Point3D.insert_3d([double_point_a], 'y', [229])[
0].coordinates, Point3D.insert_3d([self.polyline.centers[i]], 'y', [229])[0].coordinates, Block("blue_concrete")) # 0].coordinates, Point3D.insert_3d([self.polyline.centers[i]], 'y', [229])[0].coordinates, Block("blue_concrete"))
geometry.placeLine(editor, Point3D.insert_3d([double_point_b], 'y', [229])[ # geometry.placeLine(editor, Point3D.insert_3d([double_point_b], 'y', [229])[
0].coordinates, Point3D.insert_3d([self.polyline.centers[i]], 'y', [229])[0].coordinates, Block("red_concrete")) # 0].coordinates, Point3D.insert_3d([self.polyline.centers[i]], 'y', [229])[0].coordinates, Block("red_concrete"))
for j in range(len(circle)): for j in range(len(circle)):
for k in range(len(circle[j])): for k in range(len(circle[j])):
@@ -151,6 +154,38 @@ class Road:
(Point3D.insert_3d([gaps[j][k]], 'y', [ (Point3D.insert_3d([gaps[j][k]], 'y', [
self.polyline_total_line_output[nearest[0]].y])[0].coordinates, Block("white_concrete"))) self.polyline_total_line_output[nearest[0]].y])[0].coordinates, Block("white_concrete")))
def _projection_gaussian(self):
nearest_points_to_reference = []
for i in range(len(self.coordinates)):
# Index is used to space accordingly
index, point = Point3D.to_2d([self.coordinates[i]], 'y')[0].nearest(
self.polyline.total_line_output, return_index=True)
nearest_points_to_reference.append(
Point2D(index, self.coordinates[i].y))
linear_y_interpolation = []
for i in range(len(nearest_points_to_reference)-1):
linear_y_interpolation.extend(Segment2D(
nearest_points_to_reference[i], nearest_points_to_reference[i+1]).segment())
linear_y_interpolation = np.array(
Point2D.to_arrays(linear_y_interpolation))
# Extract x and y coordinates
x = linear_y_interpolation[:, 0]
y = linear_y_interpolation[:, 1]
y_smooth = gaussian_filter1d(y, sigma=5)
self.index_factor = len(y_smooth)/len(self.polyline.total_line_output)
for i in range(len(self.polyline.total_line_output)):
self.polyline_total_line_output[i] = Point3D(
self.polyline.total_line_output[i].x, y[round(i*self.index_factor)]+100, self.polyline.total_line_output[i].y)
self._surface()
self.place()
def _projection_polyline(self): def _projection_polyline(self):
nearest_points_to_reference = [] nearest_points_to_reference = []
for i in range(len(self.coordinates)): for i in range(len(self.coordinates)):
@@ -169,7 +204,7 @@ class Road:
for i in range(len(self.polyline.total_line_output)): for i in range(len(self.polyline.total_line_output)):
self.polyline_total_line_output[i] = Point3D( self.polyline_total_line_output[i] = Point3D(
self.polyline.total_line_output[i].x, self.polyline_height.total_line_output[round(i*self.index_factor)].y, self.polyline.total_line_output[i].y) self.polyline.total_line_output[i].x, self.polyline_height.total_line_output[round(i*self.index_factor)].y+70, self.polyline.total_line_output[i].y)
self._surface() self._surface()
self.place() self.place()

Binary file not shown.

Before

Width:  |  Height:  |  Size: 2.5 KiB