diff --git a/skais/ais/ais_trajectory.py b/skais/ais/ais_trajectory.py index 8a663cd41cb528e02cd00f2223f51c0f8f2aeba4..68761a7f7a54ea18f874eca3e5e85b39a5622080 100644 --- a/skais/ais/ais_trajectory.py +++ b/skais/ais/ais_trajectory.py @@ -9,7 +9,7 @@ from scipy.interpolate import interp1d from skais.utils.geography import great_circle, position_from_distance, get_coord from skais.ais.ais_points import AISPoints -from skais.utils.geometry import bresenham +from skais.utils.geometry import bresenham, dist_on_grid @jit(nopython=True) @@ -153,7 +153,7 @@ def generate_points_with_features(data, positions, features_vectors, bounds, nod @jit(nopython=True) -def generate_links(data, positions, height, width, lower_lat, upper_lat, lower_lon, upper_lon, values): +def generate_links(data, positions, height, width, lower_lat, upper_lat, lower_lon, upper_lon, values, interpolate=None): lon, lat = positions[0, 0], positions[0, 1] current_value = values[0] @@ -164,9 +164,19 @@ def generate_links(data, positions, height, width, lower_lat, upper_lat, lower_l x_nxt, y_nxt = get_coord(latitude, longitude, height, width, lower_lat, upper_lat, lower_lon, upper_lon) lon, lat = longitude, latitude - for x, y in bresenham(x_prv, y_prev, x_nxt, y_nxt): - for i in range(len(current_value)): - data[x, y, i] = current_value[i] + if interpolate is not None and nxt_value != current_value: + dist = dist_on_grid(x_prv, y_prev, x_nxt, y_nxt) + for x, y in bresenham(x_prv, y_prev, x_nxt, y_nxt): + dist_prev = dist_on_grid(x_prv, y_prev, x, y) + dist_next = dist_on_grid(x, y, x_nxt, y_nxt) + + pixel_color = current_value * (1-dist_prev/dist) + nxt_value * (1-dist_next/dist) + for i in range(len(pixel_color)): + data[x, y, i] = pixel_color[i] + else: + for x, y in bresenham(x_prv, y_prev, x_nxt, y_nxt): + for i in range(len(current_value)): + data[x, y, i] = current_value[i] current_value = nxt_value @@ -349,7 +359,7 @@ class AISTrajectory(AISPoints): return result def generate_array_from_positions(self, height=256, width=256, link=True, bounding_box='fit', ref_index=-1, - features=None, node_size=0): + features=None, node_size=0, interpolation=None): positions = self.df[['longitude', 'latitude']].to_numpy() @@ -377,7 +387,7 @@ class AISTrajectory(AISPoints): bounds = np.array(bounds) else: nb_channels = 1 - data = np.zeros((height, width, nb_channels), dtype=np.float) + data = np.zeros((height, width, nb_channels), dtype=float) if features_vectors is None: @@ -392,5 +402,5 @@ class AISTrajectory(AISPoints): lower_lat, upper_lat, lower_lon, upper_lon, ) if link: generate_links(data, positions, height, width, lower_lat, upper_lat, lower_lon, upper_lon, - generate_values(features_vectors, bounds)) + generate_values(features_vectors, bounds), interpolation) return data diff --git a/skais/tests/ais/test_ais_trajectory.py b/skais/tests/ais/test_ais_trajectory.py index 1abe4b744ab5e401d3935676fab3fe88d4f67dc3..c491f48c8f0e83a0715b58c6cba655b582677665 100644 --- a/skais/tests/ais/test_ais_trajectory.py +++ b/skais/tests/ais/test_ais_trajectory.py @@ -653,7 +653,6 @@ class TestAISTrajectoryImageGeneration(unittest.TestCase): np.testing.assert_array_equal(result, expected) - def test_generate_array_interpolate_links(self): trajectory = AISTrajectory( pd.DataFrame( @@ -667,15 +666,17 @@ class TestAISTrajectoryImageGeneration(unittest.TestCase): ) result = trajectory.generate_array_from_positions(height=9, width=18, link=True, bounding_box='fit', - features={"sog": (0, 80)}, node_size=0).reshape((9, 18), interpolation='linear') + features={"sog": (0, 80)}, node_size=0, + interpolation='linear').reshape((9, 18)) + print(result) expected = np.array([[0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.5], - [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.5], - [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.5], - [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.5], - [0, 0, 0, 0, 0, 0, 0, 0.25, 0.25, 0.25, 0, 0, 0, 0, 0, 0, 0, 0.5], - [0, 0, 0, 0, 0, 0.25, 0.25, 0, 0, 0, 0.25, 0.25, 0, 0, 0, 0, 0, 0.5], - [0, 0, 0, 0.25, 0.25, 0, 0, 0, 0, 0, 0, 0, 0.25, 0.25, 0, 0, 0, 0.5], - [0, 0.25, 0.25, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.25, 0.25, 0, 0.5], - [0.25, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.25, 0.5]]) / 2 + [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.46875], + [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.4375], + [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.40625], + [0, 0, 0, 0, 0, 0, 0, 0.125, 0.125, 0.13526987, 0, 0, 0, 0, 0, 0, 0, 0.375], + [0, 0, 0, 0, 0, 0.125, 0.125, 0, 0, 0, 0.15330406, 0.16458619, 0, 0, 0, 0, 0, 0.34375], + [0, 0, 0, 0.125, 0.125, 0, 0, 0, 0, 0, 0, 0, 0.18154526, 0.19313327, 0, 0, 0, 0.3125], + [0, 0.125, 0.125, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.20959047, 0.22158235, 0, 0.28125], + [0.125, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0.23609719, 0.25]]) np.testing.assert_array_almost_equal(result, expected) diff --git a/skais/utils/geometry.py b/skais/utils/geometry.py index 7a111d0f32f291f673eff5dca58607c80e8fb446..66f0a29328568a83bd7128674e2f3a9976d29070 100644 --- a/skais/utils/geometry.py +++ b/skais/utils/geometry.py @@ -1,5 +1,12 @@ +import numpy as np from numba import jit +@jit(nopython=True) +def dist_on_grid(x1, y1, x2, y2): + dx = int(x2 - x1) + dy = int(y2 - y1) + return np.sqrt(dx ** 2 + dy ** 2) + @jit(nopython=True) def bresenham(x1, y1, x2, y2): @@ -12,9 +19,8 @@ def bresenham(x1, y1, x2, y2): if dy < 0: sy = -1 - pixels = [] - if abs(dx) > abs(dy): # slope < 1 + if abs(dx) > abs(dy): # slope < 1 if x1 > x2: tmp = x2 x2 = x1 @@ -28,7 +34,7 @@ def bresenham(x1, y1, x2, y2): y = y1 p = (2 * abs(dy)) - abs(dx) pixels.append((x1, y1)) - + for x in range(x1 + 1, x2 + 1): if p < 0: p += 2 * abs(dy) @@ -36,7 +42,7 @@ def bresenham(x1, y1, x2, y2): y += sy p += (2 * abs(dy)) - (2 * abs(dx)) pixels.append((x, y)) - else: # slope >= 1 + else: # slope >= 1 if y1 > y2: tmp = x2 x2 = x1 @@ -59,4 +65,3 @@ def bresenham(x1, y1, x2, y2): pixels.append((x, y)) return pixels -