---

import os
import cv2
import numpy as np

# --- 1. ТОЧНЫЙ ПОИСК СЕТКИ И ВЫРАВНИВАНИЕ ПЕРСПЕКТИВЫ ---

def align_board_by_chessboard_corners(image):
    """
    Находит 49 внутренних углов шахматной доски (7x7) 
    и точно разворачивает изображение через гомографию.
    """
    gray = cv2.cvtColor(image, cv2.COLOR_BGR2GRAY)
    
    # 1. Пробуем найти внутреннюю сетку 7x7 углов
    pattern_size = (7, 7)
    found, corners = cv2.findChessboardCorners(
        gray, pattern_size, 
        cv2.CALIBCB_ADAPTIVE_THRESH + cv2.CALIBCB_NORMALIZE_IMAGE + cv2.CALIBCB_FAST_CHECK
    )

    # Если базовый метод не нашел, пробуем более современный алгоритм (если доступен)
    if not found and hasattr(cv2, 'findChessboardCornersSB'):
        found, corners = cv2.findChessboardCornersSB(gray, pattern_size)

    if found and corners is not None:
        print("[ОК] Внутреннее пересечение клеток (7x7) найдено! Применяем точную гомографию...")
        
        # Уточняем координаты углов до субпикселей
        criteria = (cv2.TERM_CRITERIA_EPS + cv2.TERM_CRITERIA_MAX_ITER, 30, 0.1)
        corners_subpix = cv2.cornerSubPix(gray, corners, (11, 11), (-1, -1), criteria)
        
        src_points = corners_subpix.reshape(-1, 2)

        # Формируем идеальные целевые координаты для внутренних 49 точек
        # На доске 400x400 каждая клетка 50x50, значит внутренние углы лежат на 50, 100, 150... 350
        dst_points = []
        for row in range(1, 8):
            for col in range(1, 8):
                dst_points.append([col * 50, row * 50])
        
        dst_points = np.array(dst_points, dtype=np.float32)

        # Вычисляем матрицу гомографии
        H, _ = cv2.findHomography(src_points, dst_points)
        if H is not None:
            aligned_board = cv2.warpPerspective(image, H, (400, 400))
            return aligned_board

    print("[ПРЕДУПРЕЖДЕНИЕ] Сетка перекрыта или не распознана. Используем стандартное кадрирование.")
    return cv2.resize(image, (400, 400))


# --- 2. HOG-ДЕКРИПТОРЫ ---

hog = cv2.HOGDescriptor(
    _winSize=(36, 36),
    _blockSize=(18, 18),
    _blockStride=(9, 9),
    _cellSize=(9, 9),
    _nbins=9
)

def extract_dominant_piece_color(cell_bgr):
    h, w = cell_bgr.shape[:2]
    center = cell_bgr[int(h * 0.25):int(h * 0.75), int(w * 0.25):int(w * 0.75)]
    return np.mean(center, axis=(0, 1)).astype(float).tolist()


def get_hog_features(crop_bgr):
    gray = cv2.cvtColor(crop_bgr, cv2.COLOR_BGR2GRAY)
    clahe = cv2.createCLAHE(clipLimit=2.0, tileGridSize=(4, 4))
    gray_norm = clahe.apply(gray)
    
    descriptor = hog.compute(gray_norm)
    if descriptor is None:
        return np.zeros((324,), dtype=np.float32)
    return descriptor.flatten()


def print_board(board_matrix, fen):
    divider = "  +" + "---+" * 8
    print("\n    a   b   c   d   e   f   g   h")
    print(divider)
    for idx, row in enumerate(board_matrix):
        rank = 8 - idx
        row_str = " | ".join([f"{p}" if p != '.' else " " for p in row])
        print(f"{rank} | {row_str} | {rank}")
        print(divider)
    print("    a   b   c   d   e   f   g   h")
    print(f"\nFEN: {fen}\n")


# --- 3. СКАНИРОВАНИЕ ДОСКИ ---

def scan_frame(cell_board, color_database, templates_hog, ALL_PIECES, variance_threshold=12.0):
    # 1. Выравнивание доски по внутренним углам клеток
    board = align_board_by_chessboard_corners(cell_board)
    
    # Сохраним отладочное фото выровненной доски
    cv2.imwrite("debug_aligned_board.png", board)
    print("[ИНФО] Сохранен файл 'debug_aligned_board.png' — можно посмотреть качество выравнивания.")

    board_matrix = []
    
    for row in range(8):
        row_pieces = []
        for col in range(8):
            cell = board[row * 50:(row + 1) * 50, col * 50:(col + 1) * 50]
            gray_cell = cv2.cvtColor(cell, cv2.COLOR_BGR2GRAY)
            center_crop = cell[7:43, 7:43]
            center_gray = gray_cell[7:43, 7:43]

            if np.std(center_gray) < variance_threshold:
                row_pieces.append('.')
                continue

            cell_hog = get_hog_features(center_crop)

            cell_color_vec = np.array(extract_dominant_piece_color(cell))
            brightness = np.mean(cell_color_vec)
            
            is_white_piece = brightness > 110
            candidate_pieces = [p for p in ALL_PIECES if p.isupper() == is_white_piece]

            best_match, min_distance = '.', float('inf')

            for piece_symbol in candidate_pieces:
                if piece_symbol not in templates_hog or piece_symbol not in color_database:
                    continue
                
                tpl_hog = templates_hog[piece_symbol]
                hog_dist = np.linalg.norm(cell_hog - tpl_hog)

                tpl_color = np.array(color_database[piece_symbol])
                color_dist = np.linalg.norm(cell_color_vec - tpl_color)

                total_dist = hog_dist + (color_dist / 100.0)

                if total_dist < min_distance:
                    min_distance = total_dist
                    best_match = piece_symbol
                    
            row_pieces.append(best_match)
        board_matrix.append(row_pieces)

    fen_rows = []
    for r in board_matrix:
        empty, row_str = 0, ""
        for p in r:
            if p == '.': empty += 1
            else:
                if empty > 0: row_str += str(empty); empty = 0
                row_str += p
        if empty > 0: row_str += str(empty)
        fen_rows.append(row_str)
        
    return board_matrix, "/".join(fen_rows) + " w - - 0 1"


# --- 4. ТОЧКА ВХОДА ---

def main():
    TEMPLATES_DIR = "extracted_pieces"
    BOARD_IMAGE_PATH = "board.png"
    
    ALL_PIECES = ['K', 'Q', 'R', 'B', 'N', 'P', 'k', 'q', 'r', 'b', 'n', 'p']
    
    PIECES_CONFIG = {
        "K": "white_K.png", "Q": "white_Q.png", "R": "white_R.png",
        "B": "white_B.png", "N": "white_N.png", "P": "white_P.png",
        "k": "black_k.png", "q": "black_q.png", "r": "black_r.png",
        "b": "black_b.png", "n": "black_n.png", "p": "black_p.png"
    }

    if not os.path.exists(TEMPLATES_DIR):
        print(f"[ОШИБКА] Папка '{TEMPLATES_DIR}' не найдена!")
        return

    templates_hog = {}
    color_database = {}

    for sym, filename in PIECES_CONFIG.items():
        path = os.path.join(TEMPLATES_DIR, filename)
        if not os.path.exists(path):
            continue

        img = cv2.imread(path)
        if img is None:
            continue

        img_50 = cv2.resize(img, (50, 50))
        crop_center = img_50[7:43, 7:43]
        
        templates_hog[sym] = get_hog_features(crop_center)
        color_database[sym] = extract_dominant_piece_color(img_50)

    if not os.path.exists(BOARD_IMAGE_PATH):
        print(f"[ОШИБКА] Файл '{BOARD_IMAGE_PATH}' не найден!")
        return

    board_img = cv2.imread(BOARD_IMAGE_PATH)
    if board_img is None:
        print("[ОШИБКА] Не удалось прочитать картинку!")
        return

    print("[1/1] Сканирование с поиском пересечений сетки...")
    matrix, fen = scan_frame(board_img, color_database, templates_hog, ALL_PIECES)
    
    print_board(matrix, fen)


if __name__ == "__main__":
    try:
        main()
    except Exception as e:
        print(f"\n[КРИТИЧЕСКАЯ ОШИБКА]: {e}")
        import traceback
        traceback.print_exc()
        
    input("\nНажмите Enter, чтобы закрыть окно...")