diff --git a/remote_control/aruco_estimator.py b/remote_control/aruco_estimator.py index 26c2478..acd9040 100644 --- a/remote_control/aruco_estimator.py +++ b/remote_control/aruco_estimator.py @@ -10,6 +10,7 @@ import pyqtgraph as pg from shapely.geometry import LineString +from shapely.affinity import scale from queue import Queue import aruco @@ -448,8 +449,11 @@ class ArucoEstimator: row_line_top = a + y_frac * vad row_line_bottom = b + y_frac * vbc - column_line = LineString([column_line_top, column_line_bottom]) - row_line = LineString([row_line_top, row_line_bottom]) + column_line_orig = LineString([column_line_top, column_line_bottom]) + row_line_orig = LineString([row_line_top, row_line_bottom]) + + column_line = scale(column_line_orig, 10, 10) + row_line = scale(row_line_orig, 10, 10) int_pt = column_line.intersection(row_line) point_of_intersection = np.array([int_pt.x, int_pt.y])