#include "vieter_tree_balancing.h"

bool vieter_tree_node_validate(vieter_tree_node *node,
                               uint64_t passed_black_nodes,
                               uint64_t expected_black_nodes) {
  // Path to NULL children should contain the same amount of black nodes
  if (node == NULL) {
    return passed_black_nodes == expected_black_nodes;
  }

  if (vieter_tree_node_get(node, vieter_tree_node_black)) {
    passed_black_nodes++;
  }

  // Either the node itself is black, or its children are both either NULL or
  // black.
  bool correctly_colored_children =
      vieter_tree_node_get(node, vieter_tree_node_black) ||
      ((node->children[0] == NULL ||
        vieter_tree_node_get(node->children[0], vieter_tree_node_black)) &&
       (node->children[1] == NULL ||
        vieter_tree_node_get(node->children[1], vieter_tree_node_black)));

  return correctly_colored_children &&
         vieter_tree_node_validate(node->children[0], passed_black_nodes,
                                   expected_black_nodes) &&
         vieter_tree_node_validate(node->children[1], passed_black_nodes,
                                   expected_black_nodes);
}

vieter_tree_node *vieter_tree_node_balance(vieter_tree_node *node) {
  vieter_tree_node *parent = node->parent;
  vieter_tree_node *grand_parent = parent->parent;
  vieter_tree_node *root = grand_parent;
  vieter_tree_node *left, *right;
  vieter_tree_node *children[4];

  uint64_t key_root = root->key;
  void *data_root = root->data;

  if (node->key < parent->key && parent->key < grand_parent->key) {
    root->key = parent->key;
    root->data = parent->data;

    parent->key = key_root;
    parent->data = data_root;

    left = node;
    right = parent;

    children[0] = node->children[0];
    children[1] = node->children[1];
    children[2] = parent->children[1];
    children[3] = grand_parent->children[1];
  } else if (node->key < parent->key && parent->key > grand_parent->key) {
    root->key = node->key;
    root->data = node->data;

    node->key = key_root;
    node->data = data_root;

    left = node;
    right = parent;

    children[0] = grand_parent->children[0];
    children[1] = node->children[0];
    children[2] = node->children[1];
    children[3] = parent->children[1];
  } else if (node->key > parent->key && parent->key < grand_parent->key) {
    root->key = node->key;
    root->data = node->data;

    node->key = key_root;
    node->data = data_root;

    left = parent;
    right = node;

    children[0] = parent->children[0];
    children[1] = node->children[0];
    children[2] = node->children[1];
    children[3] = grand_parent->children[1];
  } else {
    root->key = parent->key;
    root->data = parent->data;

    parent->key = key_root;
    parent->data = data_root;

    left = parent;
    right = node;

    children[0] = grand_parent->children[0];
    children[1] = parent->children[0];
    children[2] = node->children[0];
    children[3] = node->children[1];
  }

  vieter_tree_node_set(left, vieter_tree_node_black);
  vieter_tree_node_set(right, vieter_tree_node_black);
  vieter_tree_node_unset(root, vieter_tree_node_black);

  left->children[0] = children[0];
  left->children[1] = children[1];

  if (children[0] != NULL)
    children[0]->parent = left;

  if (children[1] != NULL)
    children[1]->parent = left;

  right->children[0] = children[2];
  right->children[1] = children[3];

  if (children[2] != NULL)
    children[2]->parent = right;

  if (children[3] != NULL)
    children[3]->parent = right;

  root->children[0] = left;
  root->children[1] = right;
  left->parent = root;
  right->parent = root;

  return root;
}

void vieter_tree_node_balance_after_insert(vieter_tree_node *node) {
  while (!vieter_tree_node_get(node, vieter_tree_node_black) &&
         node->parent != NULL &&
         !vieter_tree_node_get(node->parent, vieter_tree_node_black)) {
    node = vieter_tree_node_balance(node);
  }

  // The root must always be black
  if (node->parent == NULL) {
    vieter_tree_node_set(node, vieter_tree_node_black);
  }
}

void vieter_tree_node_remove_balanced(vieter_tree_node *node) {}