Merge tag 'trace-printf-v6.13' of git://git.kernel.org/pub/scm/linux/kernel/git/trace...

[drm/drm-misc.git] / drivers / md / dm-vdo / int-map.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright 2023 Red Hat
 */

/**
 * DOC:
 *
 * Hash table implementation of a map from integers to pointers, implemented using the Hopscotch
 * Hashing algorithm by Herlihy, Shavit, and Tzafrir (see
 * http://en.wikipedia.org/wiki/Hopscotch_hashing). This implementation does not contain any of the
 * locking/concurrency features of the algorithm, just the collision resolution scheme.
 *
 * Hopscotch Hashing is based on hashing with open addressing and linear probing. All the entries
 * are stored in a fixed array of buckets, with no dynamic allocation for collisions. Unlike linear
 * probing, all the entries that hash to a given bucket are stored within a fixed neighborhood
 * starting at that bucket. Chaining is effectively represented as a bit vector relative to each
 * bucket instead of as pointers or explicit offsets.
 *
 * When an empty bucket cannot be found within a given neighborhood, subsequent neighborhoods are
 * searched, and one or more entries will "hop" into those neighborhoods. When this process works,
 * an empty bucket will move into the desired neighborhood, allowing the entry to be added. When
 * that process fails (typically when the buckets are around 90% full), the table must be resized
 * and the all entries rehashed and added to the expanded table.
 *
 * Unlike linear probing, the number of buckets that must be searched in the worst case has a fixed
 * upper bound (the size of the neighborhood). Those entries occupy a small number of memory cache
 * lines, leading to improved use of the cache (fewer misses on both successful and unsuccessful
 * searches). Hopscotch hashing outperforms linear probing at much higher load factors, so even
 * with the increased memory burden for maintaining the hop vectors, less memory is needed to
 * achieve that performance. Hopscotch is also immune to "contamination" from deleting entries
 * since entries are genuinely removed instead of being replaced by a placeholder.
 *
 * The published description of the algorithm used a bit vector, but the paper alludes to an offset
 * scheme which is used by this implementation. Since the entries in the neighborhood are within N
 * entries of the hash bucket at the start of the neighborhood, a pair of small offset fields each
 * log2(N) bits wide is all that's needed to maintain the hops as a linked list. In order to encode
 * "no next hop" (i.e. NULL) as the natural initial value of zero, the offsets are biased by one
 * (i.e. 0 => NULL, 1 => offset=0, 2 => offset=1, etc.) We can represent neighborhoods of up to 255
 * entries with just 8+8=16 bits per entry. The hop list is sorted by hop offset so the first entry
 * in the list is always the bucket closest to the start of the neighborhood.
 *
 * While individual accesses tend to be very fast, the table resize operations are very, very
 * expensive. If an upper bound on the latency of adding an entry to the table is needed, we either
 * need to ensure the table is pre-sized to be large enough so no resize is ever needed, or we'll
 * need to develop an approach to incrementally resize the table.
 */

#include "int-map.h"

#include <linux/minmax.h>

#include "errors.h"
#include "logger.h"
#include "memory-alloc.h"
#include "numeric.h"
#include "permassert.h"

#define DEFAULT_CAPACITY 16 /* the number of neighborhoods in a new table */
#define NEIGHBORHOOD 255    /* the number of buckets in each neighborhood */
#define MAX_PROBES 1024     /* limit on the number of probes for a free bucket */
#define NULL_HOP_OFFSET 0   /* the hop offset value terminating the hop list */
#define DEFAULT_LOAD 75     /* a compromise between memory use and performance */

/**
 * struct bucket - hash bucket
 *
 * Buckets are packed together to reduce memory usage and improve cache efficiency. It would be
 * tempting to encode the hop offsets separately and maintain alignment of key/value pairs, but
 * it's crucial to keep the hop fields near the buckets that they use them so they'll tend to share
 * cache lines.
 */
struct bucket {
        /**
         * @first_hop: The biased offset of the first entry in the hop list of the neighborhood
         *             that hashes to this bucket.
         */
        u8 first_hop;
        /** @next_hop: The biased offset of the next bucket in the hop list. */
        u8 next_hop;
        /** @key: The key stored in this bucket. */
        u64 key;
        /** @value: The value stored in this bucket (NULL if empty). */
        void *value;
} __packed;

/**
 * struct int_map - The concrete definition of the opaque int_map type.
 *
 * To avoid having to wrap the neighborhoods of the last entries back around to the start of the
 * bucket array, we allocate a few more buckets at the end of the array instead, which is why
 * capacity and bucket_count are different.
 */
struct int_map {
        /** @size: The number of entries stored in the map. */
        size_t size;
        /** @capacity: The number of neighborhoods in the map. */
        size_t capacity;
        /** @bucket_count: The number of buckets in the bucket array. */
        size_t bucket_count;
        /** @buckets: The array of hash buckets. */
        struct bucket *buckets;
};

/**
 * mix() - The Google CityHash 16-byte hash mixing function.
 * @input1: The first input value.
 * @input2: The second input value.
 *
 * Return: A hash of the two inputs.
 */
static u64 mix(u64 input1, u64 input2)
{
        static const u64 CITY_MULTIPLIER = 0x9ddfea08eb382d69ULL;
        u64 hash = (input1 ^ input2);

        hash *= CITY_MULTIPLIER;
        hash ^= (hash >> 47);
        hash ^= input2;
        hash *= CITY_MULTIPLIER;
        hash ^= (hash >> 47);
        hash *= CITY_MULTIPLIER;
        return hash;
}

/**
 * hash_key() - Calculate a 64-bit non-cryptographic hash value for the provided 64-bit integer
 *              key.
 * @key: The mapping key.
 *
 * The implementation is based on Google's CityHash, only handling the specific case of an 8-byte
 * input.
 *
 * Return: The hash of the mapping key.
 */
static u64 hash_key(u64 key)
{
        /*
         * Aliasing restrictions forbid us from casting pointer types, so use a union to convert a
         * single u64 to two u32 values.
         */
        union {
                u64 u64;
                u32 u32[2];
        } pun = {.u64 = key};

        return mix(sizeof(key) + (((u64) pun.u32[0]) << 3), pun.u32[1]);
}

/**
 * allocate_buckets() - Initialize an int_map.
 * @map: The map to initialize.
 * @capacity: The initial capacity of the map.
 *
 * Return: VDO_SUCCESS or an error code.
 */
static int allocate_buckets(struct int_map *map, size_t capacity)
{
        map->size = 0;
        map->capacity = capacity;

        /*
         * Allocate NEIGHBORHOOD - 1 extra buckets so the last bucket can have a full neighborhood
         * without have to wrap back around to element zero.
         */
        map->bucket_count = capacity + (NEIGHBORHOOD - 1);
        return vdo_allocate(map->bucket_count, struct bucket,
                            "struct int_map buckets", &map->buckets);
}

/**
 * vdo_int_map_create() - Allocate and initialize an int_map.
 * @initial_capacity: The number of entries the map should initially be capable of holding (zero
 *                    tells the map to use its own small default).
 * @map_ptr: Output, a pointer to hold the new int_map.
 *
 * Return: VDO_SUCCESS or an error code.
 */
int vdo_int_map_create(size_t initial_capacity, struct int_map **map_ptr)
{
        struct int_map *map;
        int result;
        size_t capacity;

        result = vdo_allocate(1, struct int_map, "struct int_map", &map);
        if (result != VDO_SUCCESS)
                return result;

        /* Use the default capacity if the caller did not specify one. */
        capacity = (initial_capacity > 0) ? initial_capacity : DEFAULT_CAPACITY;

        /*
         * Scale up the capacity by the specified initial load factor. (i.e to hold 1000 entries at
         * 80% load we need a capacity of 1250)
         */
        capacity = capacity * 100 / DEFAULT_LOAD;

        result = allocate_buckets(map, capacity);
        if (result != VDO_SUCCESS) {
                vdo_int_map_free(vdo_forget(map));
                return result;
        }

        *map_ptr = map;
        return VDO_SUCCESS;
}

/**
 * vdo_int_map_free() - Free an int_map.
 * @map: The int_map to free.
 *
 * NOTE: The map does not own the pointer values stored in the map and they are not freed by this
 * call.
 */
void vdo_int_map_free(struct int_map *map)
{
        if (map == NULL)
                return;

        vdo_free(vdo_forget(map->buckets));
        vdo_free(vdo_forget(map));
}

/**
 * vdo_int_map_size() - Get the number of entries stored in an int_map.
 * @map: The int_map to query.
 *
 * Return: The number of entries in the map.
 */
size_t vdo_int_map_size(const struct int_map *map)
{
        return map->size;
}

/**
 * dereference_hop() - Convert a biased hop offset within a neighborhood to a pointer to the bucket
 *                     it references.
 * @neighborhood: The first bucket in the neighborhood.
 * @hop_offset: The biased hop offset to the desired bucket.
 *
 * Return: NULL if hop_offset is zero, otherwise a pointer to the bucket in the neighborhood at
 *         hop_offset - 1.
 */
static struct bucket *dereference_hop(struct bucket *neighborhood, unsigned int hop_offset)
{
        BUILD_BUG_ON(NULL_HOP_OFFSET != 0);
        if (hop_offset == NULL_HOP_OFFSET)
                return NULL;

        return &neighborhood[hop_offset - 1];
}

/**
 * insert_in_hop_list() - Add a bucket into the hop list for the neighborhood.
 * @neighborhood: The first bucket in the neighborhood.
 * @new_bucket: The bucket to add to the hop list.
 *
 * The bucket is inserted it into the list so the hop list remains sorted by hop offset.
 */
static void insert_in_hop_list(struct bucket *neighborhood, struct bucket *new_bucket)
{
        /* Zero indicates a NULL hop offset, so bias the hop offset by one. */
        int hop_offset = 1 + (new_bucket - neighborhood);

        /* Handle the special case of adding a bucket at the start of the list. */
        int next_hop = neighborhood->first_hop;

        if ((next_hop == NULL_HOP_OFFSET) || (next_hop > hop_offset)) {
                new_bucket->next_hop = next_hop;
                neighborhood->first_hop = hop_offset;
                return;
        }

        /* Search the hop list for the insertion point that maintains the sort order. */
        for (;;) {
                struct bucket *bucket = dereference_hop(neighborhood, next_hop);

                next_hop = bucket->next_hop;

                if ((next_hop == NULL_HOP_OFFSET) || (next_hop > hop_offset)) {
                        new_bucket->next_hop = next_hop;
                        bucket->next_hop = hop_offset;
                        return;
                }
        }
}

/**
 * select_bucket() - Select and return the hash bucket for a given search key.
 * @map: The map to search.
 * @key: The mapping key.
 */
static struct bucket *select_bucket(const struct int_map *map, u64 key)
{
        /*
         * Calculate a good hash value for the provided key. We want exactly 32 bits, so mask the
         * result.
         */
        u64 hash = hash_key(key) & 0xFFFFFFFF;

        /*
         * Scale the 32-bit hash to a bucket index by treating it as a binary fraction and
         * multiplying that by the capacity. If the hash is uniformly distributed over [0 ..
         * 2^32-1], then (hash * capacity / 2^32) should be uniformly distributed over [0 ..
         * capacity-1]. The multiply and shift is much faster than a divide (modulus) on X86 CPUs.
         */
        return &map->buckets[(hash * map->capacity) >> 32];
}

/**
 * search_hop_list() - Search the hop list associated with given hash bucket for a given search
 *                     key.
 * @bucket: The map bucket to search for the key.
 * @key: The mapping key.
 * @previous_ptr: Output. if not NULL, a pointer in which to store the bucket in the list preceding
 *                the one that had the matching key
 *
 * If the key is found, returns a pointer to the entry (bucket or collision), otherwise returns
 * NULL.
 *
 * Return: An entry that matches the key, or NULL if not found.
 */
static struct bucket *search_hop_list(struct bucket *bucket, u64 key,
                                      struct bucket **previous_ptr)
{
        struct bucket *previous = NULL;
        unsigned int next_hop = bucket->first_hop;

        while (next_hop != NULL_HOP_OFFSET) {
                /*
                 * Check the neighboring bucket indexed by the offset for the
                 * desired key.
                 */
                struct bucket *entry = dereference_hop(bucket, next_hop);

                if ((key == entry->key) && (entry->value != NULL)) {
                        if (previous_ptr != NULL)
                                *previous_ptr = previous;
                        return entry;
                }
                next_hop = entry->next_hop;
                previous = entry;
        }

        return NULL;
}

/**
 * vdo_int_map_get() - Retrieve the value associated with a given key from the int_map.
 * @map: The int_map to query.
 * @key: The key to look up.
 *
 * Return: The value associated with the given key, or NULL if the key is not mapped to any value.
 */
void *vdo_int_map_get(struct int_map *map, u64 key)
{
        struct bucket *match = search_hop_list(select_bucket(map, key), key, NULL);

        return ((match != NULL) ? match->value : NULL);
}

/**
 * resize_buckets() - Increase the number of hash buckets.
 * @map: The map to resize.
 *
 * Resizes and rehashes all the existing entries, storing them in the new buckets.
 *
 * Return: VDO_SUCCESS or an error code.
 */
static int resize_buckets(struct int_map *map)
{
        int result;
        size_t i;

        /* Copy the top-level map data to the stack. */
        struct int_map old_map = *map;

        /* Re-initialize the map to be empty and 50% larger. */
        size_t new_capacity = map->capacity / 2 * 3;

        vdo_log_info("%s: attempting resize from %zu to %zu, current size=%zu",
                     __func__, map->capacity, new_capacity, map->size);
        result = allocate_buckets(map, new_capacity);
        if (result != VDO_SUCCESS) {
                *map = old_map;
                return result;
        }

        /* Populate the new hash table from the entries in the old bucket array. */
        for (i = 0; i < old_map.bucket_count; i++) {
                struct bucket *entry = &old_map.buckets[i];

                if (entry->value == NULL)
                        continue;

                result = vdo_int_map_put(map, entry->key, entry->value, true, NULL);
                if (result != VDO_SUCCESS) {
                        /* Destroy the new partial map and restore the map from the stack. */
                        vdo_free(vdo_forget(map->buckets));
                        *map = old_map;
                        return result;
                }
        }

        /* Destroy the old bucket array. */
        vdo_free(vdo_forget(old_map.buckets));
        return VDO_SUCCESS;
}

/**
 * find_empty_bucket() - Probe the bucket array starting at the given bucket for the next empty
 *                       bucket, returning a pointer to it.
 * @map: The map containing the buckets to search.
 * @bucket: The bucket at which to start probing.
 * @max_probes: The maximum number of buckets to search.
 *
 * NULL will be returned if the search reaches the end of the bucket array or if the number of
 * linear probes exceeds a specified limit.
 *
 * Return: The next empty bucket, or NULL if the search failed.
 */
static struct bucket *
find_empty_bucket(struct int_map *map, struct bucket *bucket, unsigned int max_probes)
{
        /*
         * Limit the search to either the nearer of the end of the bucket array or a fixed distance
         * beyond the initial bucket.
         */
        ptrdiff_t remaining = &map->buckets[map->bucket_count] - bucket;
        struct bucket *sentinel = &bucket[min_t(ptrdiff_t, remaining, max_probes)];
        struct bucket *entry;

        for (entry = bucket; entry < sentinel; entry++) {
                if (entry->value == NULL)
                        return entry;
        }

        return NULL;
}

/**
 * move_empty_bucket() - Move an empty bucket closer to the start of the bucket array.
 * @hole: The empty bucket to fill with an entry that precedes it in one of its enclosing
 *        neighborhoods.
 *
 * This searches the neighborhoods that contain the empty bucket for a non-empty bucket closer to
 * the start of the array. If such a bucket is found, this swaps the two buckets by moving the
 * entry to the empty bucket.
 *
 * Return: The bucket that was vacated by moving its entry to the provided hole, or NULL if no
 *         entry could be moved.
 */
static struct bucket *move_empty_bucket(struct bucket *hole)
{
        /*
         * Examine every neighborhood that the empty bucket is part of, starting with the one in
         * which it is the last bucket. No boundary check is needed for the negative array
         * arithmetic since this function is only called when hole is at least NEIGHBORHOOD cells
         * deeper into the array than a valid bucket.
         */
        struct bucket *bucket;

        for (bucket = &hole[1 - NEIGHBORHOOD]; bucket < hole; bucket++) {
                /*
                 * Find the entry that is nearest to the bucket, which means it will be nearest to
                 * the hash bucket whose neighborhood is full.
                 */
                struct bucket *new_hole = dereference_hop(bucket, bucket->first_hop);

                if (new_hole == NULL) {
                        /*
                         * There are no buckets in this neighborhood that are in use by this one
                         * (they must all be owned by overlapping neighborhoods).
                         */
                        continue;
                }

                /*
                 * Skip this bucket if its first entry is actually further away than the hole that
                 * we're already trying to fill.
                 */
                if (hole < new_hole)
                        continue;

                /*
                 * We've found an entry in this neighborhood that we can "hop" further away, moving
                 * the hole closer to the hash bucket, if not all the way into its neighborhood.
                 */

                /*
                 * The entry that will be the new hole is the first bucket in the list, so setting
                 * first_hop is all that's needed remove it from the list.
                 */
                bucket->first_hop = new_hole->next_hop;
                new_hole->next_hop = NULL_HOP_OFFSET;

                /* Move the entry into the original hole. */
                hole->key = new_hole->key;
                hole->value = new_hole->value;
                new_hole->value = NULL;

                /* Insert the filled hole into the hop list for the neighborhood. */
                insert_in_hop_list(bucket, hole);
                return new_hole;
        }

        /* We couldn't find an entry to relocate to the hole. */
        return NULL;
}

/**
 * update_mapping() - Find and update any existing mapping for a given key, returning the value
 *                    associated with the key in the provided pointer.
 * @neighborhood: The first bucket in the neighborhood that would contain the search key
 * @key: The key with which to associate the new value.
 * @new_value: The value to be associated with the key.
 * @update: Whether to overwrite an existing value.
 * @old_value_ptr: a pointer in which to store the old value (unmodified if no mapping was found)
 *
 * Return: true if the map contains a mapping for the key, false if it does not.
 */
static bool update_mapping(struct bucket *neighborhood, u64 key, void *new_value,
                           bool update, void **old_value_ptr)
{
        struct bucket *bucket = search_hop_list(neighborhood, key, NULL);

        if (bucket == NULL) {
                /* There is no bucket containing the key in the neighborhood. */
                return false;
        }

        /*
         * Return the value of the current mapping (if desired) and update the mapping with the new
         * value (if desired).
         */
        if (old_value_ptr != NULL)
                *old_value_ptr = bucket->value;
        if (update)
                bucket->value = new_value;
        return true;
}

/**
 * find_or_make_vacancy() - Find an empty bucket.
 * @map: The int_map to search or modify.
 * @neighborhood: The first bucket in the neighborhood in which an empty bucket is needed for a new
 *                mapping.
 *
 * Find an empty bucket in a specified neighborhood for a new mapping or attempt to re-arrange
 * mappings so there is such a bucket. This operation may fail (returning NULL) if an empty bucket
 * is not available or could not be relocated to the neighborhood.
 *
 * Return: a pointer to an empty bucket in the desired neighborhood, or NULL if a vacancy could not
 *         be found or arranged.
 */
static struct bucket *find_or_make_vacancy(struct int_map *map,
                                           struct bucket *neighborhood)
{
        /* Probe within and beyond the neighborhood for the first empty bucket. */
        struct bucket *hole = find_empty_bucket(map, neighborhood, MAX_PROBES);

        /*
         * Keep trying until the empty bucket is in the bucket's neighborhood or we are unable to
         * move it any closer by swapping it with a filled bucket.
         */
        while (hole != NULL) {
                int distance = hole - neighborhood;

                if (distance < NEIGHBORHOOD) {
                        /*
                         * We've found or relocated an empty bucket close enough to the initial
                         * hash bucket to be referenced by its hop vector.
                         */
                        return hole;
                }

                /*
                 * The nearest empty bucket isn't within the neighborhood that must contain the new
                 * entry, so try to swap it with bucket that is closer.
                 */
                hole = move_empty_bucket(hole);
        }

        return NULL;
}

/**
 * vdo_int_map_put() - Try to associate a value with an integer.
 * @map: The int_map to attempt to modify.
 * @key: The key with which to associate the new value.
 * @new_value: The value to be associated with the key.
 * @update: Whether to overwrite an existing value.
 * @old_value_ptr: A pointer in which to store either the old value (if the key was already mapped)
 *                 or NULL if the map did not contain the key; NULL may be provided if the caller
 *                 does not need to know the old value
 *
 * Try to associate a value (a pointer) with an integer in an int_map. If the map already contains
 * a mapping for the provided key, the old value is only replaced with the specified value if
 * update is true. In either case the old value is returned. If the map does not already contain a
 * value for the specified key, the new value is added regardless of the value of update.
 *
 * Return: VDO_SUCCESS or an error code.
 */
int vdo_int_map_put(struct int_map *map, u64 key, void *new_value, bool update,
                    void **old_value_ptr)
{
        struct bucket *neighborhood, *bucket;

        if (unlikely(new_value == NULL))
                return -EINVAL;

        /*
         * Select the bucket at the start of the neighborhood that must contain any entry for the
         * provided key.
         */
        neighborhood = select_bucket(map, key);

        /*
         * Check whether the neighborhood already contains an entry for the key, in which case we
         * optionally update it, returning the old value.
         */
        if (update_mapping(neighborhood, key, new_value, update, old_value_ptr))
                return VDO_SUCCESS;

        /*
         * Find an empty bucket in the desired neighborhood for the new entry or re-arrange entries
         * in the map so there is such a bucket. This operation will usually succeed; the loop body
         * will only be executed on the rare occasions that we have to resize the map.
         */
        while ((bucket = find_or_make_vacancy(map, neighborhood)) == NULL) {
                int result;

                /*
                 * There is no empty bucket in which to put the new entry in the current map, so
                 * we're forced to allocate a new bucket array with a larger capacity, re-hash all
                 * the entries into those buckets, and try again (a very expensive operation for
                 * large maps).
                 */
                result = resize_buckets(map);
                if (result != VDO_SUCCESS)
                        return result;

                /*
                 * Resizing the map invalidates all pointers to buckets, so recalculate the
                 * neighborhood pointer.
                 */
                neighborhood = select_bucket(map, key);
        }

        /* Put the new entry in the empty bucket, adding it to the neighborhood. */
        bucket->key = key;
        bucket->value = new_value;
        insert_in_hop_list(neighborhood, bucket);
        map->size += 1;

        /* There was no existing entry, so there was no old value to be returned. */
        if (old_value_ptr != NULL)
                *old_value_ptr = NULL;
        return VDO_SUCCESS;
}

/**
 * vdo_int_map_remove() - Remove the mapping for a given key from the int_map.
 * @map: The int_map from which to remove the mapping.
 * @key: The key whose mapping is to be removed.
 *
 * Return: the value that was associated with the key, or NULL if it was not mapped.
 */
void *vdo_int_map_remove(struct int_map *map, u64 key)
{
        void *value;

        /* Select the bucket to search and search it for an existing entry. */
        struct bucket *bucket = select_bucket(map, key);
        struct bucket *previous;
        struct bucket *victim = search_hop_list(bucket, key, &previous);

        if (victim == NULL) {
                /* There is no matching entry to remove. */
                return NULL;
        }

        /*
         * We found an entry to remove. Save the mapped value to return later and empty the bucket.
         */
        map->size -= 1;
        value = victim->value;
        victim->value = NULL;
        victim->key = 0;

        /* The victim bucket is now empty, but it still needs to be spliced out of the hop list. */
        if (previous == NULL) {
                /* The victim is the head of the list, so swing first_hop. */
                bucket->first_hop = victim->next_hop;
        } else {
                previous->next_hop = victim->next_hop;
        }

        victim->next_hop = NULL_HOP_OFFSET;
        return value;
}