import hashlib
from pathlib import Path

import numpy as np
import pandas as pd

from cache import HDFCache
from utils import print_progress

cache = HDFCache(Path("center_cache.hdf5"))


def find_center(df: pd.DataFrame, center: np.ndarray, initial_radius=1):
    # plt.figure()
    all_particles = df[["X", "Y", "Z"]].to_numpy()
    hashdata = hashlib.sha256()
    hashdata.update(np.ascontiguousarray(all_particles).data)
    hashdata.update(np.ascontiguousarray(center).data)
    hashdata.update(np.array(initial_radius))
    hash = hashdata.hexdigest()
    cached_center = cache.get(hash)
    if cached_center is not None:
        return np.array(cached_center)
    radius = initial_radius
    center_history = []
    i = 0
    while True:
        center_history.append(center)
        distances = np.linalg.norm(all_particles - center, axis=1)
        in_radius_particles = all_particles[distances < radius]
        num_particles = in_radius_particles.shape[0]
        print_progress(i, "?", f"n={num_particles}, r={radius}, c={center}")
        if num_particles < 10:
            break
        center_of_mass = in_radius_particles.mean(axis=0)
        new_center = (center_of_mass + center) / 2
        shift = np.linalg.norm(center - new_center)
        radius = max(0.8 * shift, radius * 0.9)
        center = new_center
        i += 1
    center_history = np.array(center_history)
    # print(center_history)
    # plt.scatter(center_history[::, 0], center_history[::, 1], c=range(len(center_history[::, 1])))
    # plt.colorbar(label="step")
    # plt.show()
    print()
    cache.set(hash, center)
    return center