qemu

FORK: QEMU emulator
git clone https://git.neptards.moe/neptards/qemu.git
Log | Files | Refs | Submodules | LICENSE

qht.c (27190B)


      1 /*
      2  * qht.c - QEMU Hash Table, designed to scale for read-mostly workloads.
      3  *
      4  * Copyright (C) 2016, Emilio G. Cota <cota@braap.org>
      5  *
      6  * License: GNU GPL, version 2 or later.
      7  *   See the COPYING file in the top-level directory.
      8  *
      9  * Assumptions:
     10  * - NULL cannot be inserted/removed as a pointer value.
     11  * - Trying to insert an already-existing hash-pointer pair is OK. However,
     12  *   it is not OK to insert into the same hash table different hash-pointer
     13  *   pairs that have the same pointer value, but not the hashes.
     14  * - Lookups are performed under an RCU read-critical section; removals
     15  *   must wait for a grace period to elapse before freeing removed objects.
     16  *
     17  * Features:
     18  * - Reads (i.e. lookups and iterators) can be concurrent with other reads.
     19  *   Lookups that are concurrent with writes to the same bucket will retry
     20  *   via a seqlock; iterators acquire all bucket locks and therefore can be
     21  *   concurrent with lookups and are serialized wrt writers.
     22  * - Writes (i.e. insertions/removals) can be concurrent with writes to
     23  *   different buckets; writes to the same bucket are serialized through a lock.
     24  * - Optional auto-resizing: the hash table resizes up if the load surpasses
     25  *   a certain threshold. Resizing is done concurrently with readers; writes
     26  *   are serialized with the resize operation.
     27  *
     28  * The key structure is the bucket, which is cacheline-sized. Buckets
     29  * contain a few hash values and pointers; the u32 hash values are stored in
     30  * full so that resizing is fast. Having this structure instead of directly
     31  * chaining items has two advantages:
     32  * - Failed lookups fail fast, and touch a minimum number of cache lines.
     33  * - Resizing the hash table with concurrent lookups is easy.
     34  *
     35  * There are two types of buckets:
     36  * 1. "head" buckets are the ones allocated in the array of buckets in qht_map.
     37  * 2. all "non-head" buckets (i.e. all others) are members of a chain that
     38  *    starts from a head bucket.
     39  * Note that the seqlock and spinlock of a head bucket applies to all buckets
     40  * chained to it; these two fields are unused in non-head buckets.
     41  *
     42  * On removals, we move the last valid item in the chain to the position of the
     43  * just-removed entry. This makes lookups slightly faster, since the moment an
     44  * invalid entry is found, the (failed) lookup is over.
     45  *
     46  * Resizing is done by taking all bucket spinlocks (so that no other writers can
     47  * race with us) and then copying all entries into a new hash map. Then, the
     48  * ht->map pointer is set, and the old map is freed once no RCU readers can see
     49  * it anymore.
     50  *
     51  * Writers check for concurrent resizes by comparing ht->map before and after
     52  * acquiring their bucket lock. If they don't match, a resize has occurred
     53  * while the bucket spinlock was being acquired.
     54  *
     55  * Related Work:
     56  * - Idea of cacheline-sized buckets with full hashes taken from:
     57  *   David, Guerraoui & Trigonakis, "Asynchronized Concurrency:
     58  *   The Secret to Scaling Concurrent Search Data Structures", ASPLOS'15.
     59  * - Why not RCU-based hash tables? They would allow us to get rid of the
     60  *   seqlock, but resizing would take forever since RCU read critical
     61  *   sections in QEMU take quite a long time.
     62  *   More info on relativistic hash tables:
     63  *   + Triplett, McKenney & Walpole, "Resizable, Scalable, Concurrent Hash
     64  *     Tables via Relativistic Programming", USENIX ATC'11.
     65  *   + Corbet, "Relativistic hash tables, part 1: Algorithms", @ lwn.net, 2014.
     66  *     https://lwn.net/Articles/612021/
     67  */
     68 #include "qemu/osdep.h"
     69 #include "qemu/qht.h"
     70 #include "qemu/atomic.h"
     71 #include "qemu/rcu.h"
     72 #include "qemu/memalign.h"
     73 
     74 //#define QHT_DEBUG
     75 
     76 /*
     77  * We want to avoid false sharing of cache lines. Most systems have 64-byte
     78  * cache lines so we go with it for simplicity.
     79  *
     80  * Note that systems with smaller cache lines will be fine (the struct is
     81  * almost 64-bytes); systems with larger cache lines might suffer from
     82  * some false sharing.
     83  */
     84 #define QHT_BUCKET_ALIGN 64
     85 
     86 /* define these to keep sizeof(qht_bucket) within QHT_BUCKET_ALIGN */
     87 #if HOST_LONG_BITS == 32
     88 #define QHT_BUCKET_ENTRIES 6
     89 #else /* 64-bit */
     90 #define QHT_BUCKET_ENTRIES 4
     91 #endif
     92 
     93 enum qht_iter_type {
     94     QHT_ITER_VOID,    /* do nothing; use retvoid */
     95     QHT_ITER_RM,      /* remove element if retbool returns true */
     96 };
     97 
     98 struct qht_iter {
     99     union {
    100         qht_iter_func_t retvoid;
    101         qht_iter_bool_func_t retbool;
    102     } f;
    103     enum qht_iter_type type;
    104 };
    105 
    106 /*
    107  * Do _not_ use qemu_mutex_[try]lock directly! Use these macros, otherwise
    108  * the profiler (QSP) will deadlock.
    109  */
    110 static inline void qht_lock(struct qht *ht)
    111 {
    112     if (ht->mode & QHT_MODE_RAW_MUTEXES) {
    113         qemu_mutex_lock__raw(&ht->lock);
    114     } else {
    115         qemu_mutex_lock(&ht->lock);
    116     }
    117 }
    118 
    119 static inline int qht_trylock(struct qht *ht)
    120 {
    121     if (ht->mode & QHT_MODE_RAW_MUTEXES) {
    122         return qemu_mutex_trylock__raw(&(ht)->lock);
    123     }
    124     return qemu_mutex_trylock(&(ht)->lock);
    125 }
    126 
    127 /* this inline is not really necessary, but it helps keep code consistent */
    128 static inline void qht_unlock(struct qht *ht)
    129 {
    130     qemu_mutex_unlock(&ht->lock);
    131 }
    132 
    133 /*
    134  * Note: reading partially-updated pointers in @pointers could lead to
    135  * segfaults. We thus access them with qatomic_read/set; this guarantees
    136  * that the compiler makes all those accesses atomic. We also need the
    137  * volatile-like behavior in qatomic_read, since otherwise the compiler
    138  * might refetch the pointer.
    139  * qatomic_read's are of course not necessary when the bucket lock is held.
    140  *
    141  * If both ht->lock and b->lock are grabbed, ht->lock should always
    142  * be grabbed first.
    143  */
    144 struct qht_bucket {
    145     QemuSpin lock;
    146     QemuSeqLock sequence;
    147     uint32_t hashes[QHT_BUCKET_ENTRIES];
    148     void *pointers[QHT_BUCKET_ENTRIES];
    149     struct qht_bucket *next;
    150 } QEMU_ALIGNED(QHT_BUCKET_ALIGN);
    151 
    152 QEMU_BUILD_BUG_ON(sizeof(struct qht_bucket) > QHT_BUCKET_ALIGN);
    153 
    154 /**
    155  * struct qht_map - structure to track an array of buckets
    156  * @rcu: used by RCU. Keep it as the top field in the struct to help valgrind
    157  *       find the whole struct.
    158  * @buckets: array of head buckets. It is constant once the map is created.
    159  * @n_buckets: number of head buckets. It is constant once the map is created.
    160  * @n_added_buckets: number of added (i.e. "non-head") buckets
    161  * @n_added_buckets_threshold: threshold to trigger an upward resize once the
    162  *                             number of added buckets surpasses it.
    163  *
    164  * Buckets are tracked in what we call a "map", i.e. this structure.
    165  */
    166 struct qht_map {
    167     struct rcu_head rcu;
    168     struct qht_bucket *buckets;
    169     size_t n_buckets;
    170     size_t n_added_buckets;
    171     size_t n_added_buckets_threshold;
    172 };
    173 
    174 /* trigger a resize when n_added_buckets > n_buckets / div */
    175 #define QHT_NR_ADDED_BUCKETS_THRESHOLD_DIV 8
    176 
    177 static void qht_do_resize_reset(struct qht *ht, struct qht_map *new,
    178                                 bool reset);
    179 static void qht_grow_maybe(struct qht *ht);
    180 
    181 #ifdef QHT_DEBUG
    182 
    183 #define qht_debug_assert(X) do { assert(X); } while (0)
    184 
    185 static void qht_bucket_debug__locked(struct qht_bucket *b)
    186 {
    187     bool seen_empty = false;
    188     bool corrupt = false;
    189     int i;
    190 
    191     do {
    192         for (i = 0; i < QHT_BUCKET_ENTRIES; i++) {
    193             if (b->pointers[i] == NULL) {
    194                 seen_empty = true;
    195                 continue;
    196             }
    197             if (seen_empty) {
    198                 fprintf(stderr, "%s: b: %p, pos: %i, hash: 0x%x, p: %p\n",
    199                         __func__, b, i, b->hashes[i], b->pointers[i]);
    200                 corrupt = true;
    201             }
    202         }
    203         b = b->next;
    204     } while (b);
    205     qht_debug_assert(!corrupt);
    206 }
    207 
    208 static void qht_map_debug__all_locked(struct qht_map *map)
    209 {
    210     int i;
    211 
    212     for (i = 0; i < map->n_buckets; i++) {
    213         qht_bucket_debug__locked(&map->buckets[i]);
    214     }
    215 }
    216 #else
    217 
    218 #define qht_debug_assert(X) do { (void)(X); } while (0)
    219 
    220 static inline void qht_bucket_debug__locked(struct qht_bucket *b)
    221 { }
    222 
    223 static inline void qht_map_debug__all_locked(struct qht_map *map)
    224 { }
    225 #endif /* QHT_DEBUG */
    226 
    227 static inline size_t qht_elems_to_buckets(size_t n_elems)
    228 {
    229     return pow2ceil(n_elems / QHT_BUCKET_ENTRIES);
    230 }
    231 
    232 static inline void qht_head_init(struct qht_bucket *b)
    233 {
    234     memset(b, 0, sizeof(*b));
    235     qemu_spin_init(&b->lock);
    236     seqlock_init(&b->sequence);
    237 }
    238 
    239 static inline
    240 struct qht_bucket *qht_map_to_bucket(const struct qht_map *map, uint32_t hash)
    241 {
    242     return &map->buckets[hash & (map->n_buckets - 1)];
    243 }
    244 
    245 /* acquire all bucket locks from a map */
    246 static void qht_map_lock_buckets(struct qht_map *map)
    247 {
    248     size_t i;
    249 
    250     for (i = 0; i < map->n_buckets; i++) {
    251         struct qht_bucket *b = &map->buckets[i];
    252 
    253         qemu_spin_lock(&b->lock);
    254     }
    255 }
    256 
    257 static void qht_map_unlock_buckets(struct qht_map *map)
    258 {
    259     size_t i;
    260 
    261     for (i = 0; i < map->n_buckets; i++) {
    262         struct qht_bucket *b = &map->buckets[i];
    263 
    264         qemu_spin_unlock(&b->lock);
    265     }
    266 }
    267 
    268 /*
    269  * Call with at least a bucket lock held.
    270  * @map should be the value read before acquiring the lock (or locks).
    271  */
    272 static inline bool qht_map_is_stale__locked(const struct qht *ht,
    273                                             const struct qht_map *map)
    274 {
    275     return map != ht->map;
    276 }
    277 
    278 /*
    279  * Grab all bucket locks, and set @pmap after making sure the map isn't stale.
    280  *
    281  * Pairs with qht_map_unlock_buckets(), hence the pass-by-reference.
    282  *
    283  * Note: callers cannot have ht->lock held.
    284  */
    285 static inline
    286 void qht_map_lock_buckets__no_stale(struct qht *ht, struct qht_map **pmap)
    287 {
    288     struct qht_map *map;
    289 
    290     map = qatomic_rcu_read(&ht->map);
    291     qht_map_lock_buckets(map);
    292     if (likely(!qht_map_is_stale__locked(ht, map))) {
    293         *pmap = map;
    294         return;
    295     }
    296     qht_map_unlock_buckets(map);
    297 
    298     /* we raced with a resize; acquire ht->lock to see the updated ht->map */
    299     qht_lock(ht);
    300     map = ht->map;
    301     qht_map_lock_buckets(map);
    302     qht_unlock(ht);
    303     *pmap = map;
    304     return;
    305 }
    306 
    307 /*
    308  * Get a head bucket and lock it, making sure its parent map is not stale.
    309  * @pmap is filled with a pointer to the bucket's parent map.
    310  *
    311  * Unlock with qemu_spin_unlock(&b->lock).
    312  *
    313  * Note: callers cannot have ht->lock held.
    314  */
    315 static inline
    316 struct qht_bucket *qht_bucket_lock__no_stale(struct qht *ht, uint32_t hash,
    317                                              struct qht_map **pmap)
    318 {
    319     struct qht_bucket *b;
    320     struct qht_map *map;
    321 
    322     map = qatomic_rcu_read(&ht->map);
    323     b = qht_map_to_bucket(map, hash);
    324 
    325     qemu_spin_lock(&b->lock);
    326     if (likely(!qht_map_is_stale__locked(ht, map))) {
    327         *pmap = map;
    328         return b;
    329     }
    330     qemu_spin_unlock(&b->lock);
    331 
    332     /* we raced with a resize; acquire ht->lock to see the updated ht->map */
    333     qht_lock(ht);
    334     map = ht->map;
    335     b = qht_map_to_bucket(map, hash);
    336     qemu_spin_lock(&b->lock);
    337     qht_unlock(ht);
    338     *pmap = map;
    339     return b;
    340 }
    341 
    342 static inline bool qht_map_needs_resize(const struct qht_map *map)
    343 {
    344     return qatomic_read(&map->n_added_buckets) >
    345            map->n_added_buckets_threshold;
    346 }
    347 
    348 static inline void qht_chain_destroy(const struct qht_bucket *head)
    349 {
    350     struct qht_bucket *curr = head->next;
    351     struct qht_bucket *prev;
    352 
    353     qemu_spin_destroy(&head->lock);
    354     while (curr) {
    355         prev = curr;
    356         curr = curr->next;
    357         qemu_vfree(prev);
    358     }
    359 }
    360 
    361 /* pass only an orphan map */
    362 static void qht_map_destroy(struct qht_map *map)
    363 {
    364     size_t i;
    365 
    366     for (i = 0; i < map->n_buckets; i++) {
    367         qht_chain_destroy(&map->buckets[i]);
    368     }
    369     qemu_vfree(map->buckets);
    370     g_free(map);
    371 }
    372 
    373 static struct qht_map *qht_map_create(size_t n_buckets)
    374 {
    375     struct qht_map *map;
    376     size_t i;
    377 
    378     map = g_malloc(sizeof(*map));
    379     map->n_buckets = n_buckets;
    380 
    381     map->n_added_buckets = 0;
    382     map->n_added_buckets_threshold = n_buckets /
    383         QHT_NR_ADDED_BUCKETS_THRESHOLD_DIV;
    384 
    385     /* let tiny hash tables to at least add one non-head bucket */
    386     if (unlikely(map->n_added_buckets_threshold == 0)) {
    387         map->n_added_buckets_threshold = 1;
    388     }
    389 
    390     map->buckets = qemu_memalign(QHT_BUCKET_ALIGN,
    391                                  sizeof(*map->buckets) * n_buckets);
    392     for (i = 0; i < n_buckets; i++) {
    393         qht_head_init(&map->buckets[i]);
    394     }
    395     return map;
    396 }
    397 
    398 void qht_init(struct qht *ht, qht_cmp_func_t cmp, size_t n_elems,
    399               unsigned int mode)
    400 {
    401     struct qht_map *map;
    402     size_t n_buckets = qht_elems_to_buckets(n_elems);
    403 
    404     g_assert(cmp);
    405     ht->cmp = cmp;
    406     ht->mode = mode;
    407     qemu_mutex_init(&ht->lock);
    408     map = qht_map_create(n_buckets);
    409     qatomic_rcu_set(&ht->map, map);
    410 }
    411 
    412 /* call only when there are no readers/writers left */
    413 void qht_destroy(struct qht *ht)
    414 {
    415     qht_map_destroy(ht->map);
    416     memset(ht, 0, sizeof(*ht));
    417 }
    418 
    419 static void qht_bucket_reset__locked(struct qht_bucket *head)
    420 {
    421     struct qht_bucket *b = head;
    422     int i;
    423 
    424     seqlock_write_begin(&head->sequence);
    425     do {
    426         for (i = 0; i < QHT_BUCKET_ENTRIES; i++) {
    427             if (b->pointers[i] == NULL) {
    428                 goto done;
    429             }
    430             qatomic_set(&b->hashes[i], 0);
    431             qatomic_set(&b->pointers[i], NULL);
    432         }
    433         b = b->next;
    434     } while (b);
    435  done:
    436     seqlock_write_end(&head->sequence);
    437 }
    438 
    439 /* call with all bucket locks held */
    440 static void qht_map_reset__all_locked(struct qht_map *map)
    441 {
    442     size_t i;
    443 
    444     for (i = 0; i < map->n_buckets; i++) {
    445         qht_bucket_reset__locked(&map->buckets[i]);
    446     }
    447     qht_map_debug__all_locked(map);
    448 }
    449 
    450 void qht_reset(struct qht *ht)
    451 {
    452     struct qht_map *map;
    453 
    454     qht_map_lock_buckets__no_stale(ht, &map);
    455     qht_map_reset__all_locked(map);
    456     qht_map_unlock_buckets(map);
    457 }
    458 
    459 static inline void qht_do_resize(struct qht *ht, struct qht_map *new)
    460 {
    461     qht_do_resize_reset(ht, new, false);
    462 }
    463 
    464 static inline void qht_do_resize_and_reset(struct qht *ht, struct qht_map *new)
    465 {
    466     qht_do_resize_reset(ht, new, true);
    467 }
    468 
    469 bool qht_reset_size(struct qht *ht, size_t n_elems)
    470 {
    471     struct qht_map *new = NULL;
    472     struct qht_map *map;
    473     size_t n_buckets;
    474 
    475     n_buckets = qht_elems_to_buckets(n_elems);
    476 
    477     qht_lock(ht);
    478     map = ht->map;
    479     if (n_buckets != map->n_buckets) {
    480         new = qht_map_create(n_buckets);
    481     }
    482     qht_do_resize_and_reset(ht, new);
    483     qht_unlock(ht);
    484 
    485     return !!new;
    486 }
    487 
    488 static inline
    489 void *qht_do_lookup(const struct qht_bucket *head, qht_lookup_func_t func,
    490                     const void *userp, uint32_t hash)
    491 {
    492     const struct qht_bucket *b = head;
    493     int i;
    494 
    495     do {
    496         for (i = 0; i < QHT_BUCKET_ENTRIES; i++) {
    497             if (qatomic_read(&b->hashes[i]) == hash) {
    498                 /* The pointer is dereferenced before seqlock_read_retry,
    499                  * so (unlike qht_insert__locked) we need to use
    500                  * qatomic_rcu_read here.
    501                  */
    502                 void *p = qatomic_rcu_read(&b->pointers[i]);
    503 
    504                 if (likely(p) && likely(func(p, userp))) {
    505                     return p;
    506                 }
    507             }
    508         }
    509         b = qatomic_rcu_read(&b->next);
    510     } while (b);
    511 
    512     return NULL;
    513 }
    514 
    515 static __attribute__((noinline))
    516 void *qht_lookup__slowpath(const struct qht_bucket *b, qht_lookup_func_t func,
    517                            const void *userp, uint32_t hash)
    518 {
    519     unsigned int version;
    520     void *ret;
    521 
    522     do {
    523         version = seqlock_read_begin(&b->sequence);
    524         ret = qht_do_lookup(b, func, userp, hash);
    525     } while (seqlock_read_retry(&b->sequence, version));
    526     return ret;
    527 }
    528 
    529 void *qht_lookup_custom(const struct qht *ht, const void *userp, uint32_t hash,
    530                         qht_lookup_func_t func)
    531 {
    532     const struct qht_bucket *b;
    533     const struct qht_map *map;
    534     unsigned int version;
    535     void *ret;
    536 
    537     map = qatomic_rcu_read(&ht->map);
    538     b = qht_map_to_bucket(map, hash);
    539 
    540     version = seqlock_read_begin(&b->sequence);
    541     ret = qht_do_lookup(b, func, userp, hash);
    542     if (likely(!seqlock_read_retry(&b->sequence, version))) {
    543         return ret;
    544     }
    545     /*
    546      * Removing the do/while from the fastpath gives a 4% perf. increase when
    547      * running a 100%-lookup microbenchmark.
    548      */
    549     return qht_lookup__slowpath(b, func, userp, hash);
    550 }
    551 
    552 void *qht_lookup(const struct qht *ht, const void *userp, uint32_t hash)
    553 {
    554     return qht_lookup_custom(ht, userp, hash, ht->cmp);
    555 }
    556 
    557 /*
    558  * call with head->lock held
    559  * @ht is const since it is only used for ht->cmp()
    560  */
    561 static void *qht_insert__locked(const struct qht *ht, struct qht_map *map,
    562                                 struct qht_bucket *head, void *p, uint32_t hash,
    563                                 bool *needs_resize)
    564 {
    565     struct qht_bucket *b = head;
    566     struct qht_bucket *prev = NULL;
    567     struct qht_bucket *new = NULL;
    568     int i;
    569 
    570     do {
    571         for (i = 0; i < QHT_BUCKET_ENTRIES; i++) {
    572             if (b->pointers[i]) {
    573                 if (unlikely(b->hashes[i] == hash &&
    574                              ht->cmp(b->pointers[i], p))) {
    575                     return b->pointers[i];
    576                 }
    577             } else {
    578                 goto found;
    579             }
    580         }
    581         prev = b;
    582         b = b->next;
    583     } while (b);
    584 
    585     b = qemu_memalign(QHT_BUCKET_ALIGN, sizeof(*b));
    586     memset(b, 0, sizeof(*b));
    587     new = b;
    588     i = 0;
    589     qatomic_inc(&map->n_added_buckets);
    590     if (unlikely(qht_map_needs_resize(map)) && needs_resize) {
    591         *needs_resize = true;
    592     }
    593 
    594  found:
    595     /* found an empty key: acquire the seqlock and write */
    596     seqlock_write_begin(&head->sequence);
    597     if (new) {
    598         qatomic_rcu_set(&prev->next, b);
    599     }
    600     /* smp_wmb() implicit in seqlock_write_begin.  */
    601     qatomic_set(&b->hashes[i], hash);
    602     qatomic_set(&b->pointers[i], p);
    603     seqlock_write_end(&head->sequence);
    604     return NULL;
    605 }
    606 
    607 static __attribute__((noinline)) void qht_grow_maybe(struct qht *ht)
    608 {
    609     struct qht_map *map;
    610 
    611     /*
    612      * If the lock is taken it probably means there's an ongoing resize,
    613      * so bail out.
    614      */
    615     if (qht_trylock(ht)) {
    616         return;
    617     }
    618     map = ht->map;
    619     /* another thread might have just performed the resize we were after */
    620     if (qht_map_needs_resize(map)) {
    621         struct qht_map *new = qht_map_create(map->n_buckets * 2);
    622 
    623         qht_do_resize(ht, new);
    624     }
    625     qht_unlock(ht);
    626 }
    627 
    628 bool qht_insert(struct qht *ht, void *p, uint32_t hash, void **existing)
    629 {
    630     struct qht_bucket *b;
    631     struct qht_map *map;
    632     bool needs_resize = false;
    633     void *prev;
    634 
    635     /* NULL pointers are not supported */
    636     qht_debug_assert(p);
    637 
    638     b = qht_bucket_lock__no_stale(ht, hash, &map);
    639     prev = qht_insert__locked(ht, map, b, p, hash, &needs_resize);
    640     qht_bucket_debug__locked(b);
    641     qemu_spin_unlock(&b->lock);
    642 
    643     if (unlikely(needs_resize) && ht->mode & QHT_MODE_AUTO_RESIZE) {
    644         qht_grow_maybe(ht);
    645     }
    646     if (likely(prev == NULL)) {
    647         return true;
    648     }
    649     if (existing) {
    650         *existing = prev;
    651     }
    652     return false;
    653 }
    654 
    655 static inline bool qht_entry_is_last(const struct qht_bucket *b, int pos)
    656 {
    657     if (pos == QHT_BUCKET_ENTRIES - 1) {
    658         if (b->next == NULL) {
    659             return true;
    660         }
    661         return b->next->pointers[0] == NULL;
    662     }
    663     return b->pointers[pos + 1] == NULL;
    664 }
    665 
    666 static void
    667 qht_entry_move(struct qht_bucket *to, int i, struct qht_bucket *from, int j)
    668 {
    669     qht_debug_assert(!(to == from && i == j));
    670     qht_debug_assert(to->pointers[i]);
    671     qht_debug_assert(from->pointers[j]);
    672 
    673     qatomic_set(&to->hashes[i], from->hashes[j]);
    674     qatomic_set(&to->pointers[i], from->pointers[j]);
    675 
    676     qatomic_set(&from->hashes[j], 0);
    677     qatomic_set(&from->pointers[j], NULL);
    678 }
    679 
    680 /*
    681  * Find the last valid entry in @orig, and swap it with @orig[pos], which has
    682  * just been invalidated.
    683  */
    684 static inline void qht_bucket_remove_entry(struct qht_bucket *orig, int pos)
    685 {
    686     struct qht_bucket *b = orig;
    687     struct qht_bucket *prev = NULL;
    688     int i;
    689 
    690     if (qht_entry_is_last(orig, pos)) {
    691         orig->hashes[pos] = 0;
    692         qatomic_set(&orig->pointers[pos], NULL);
    693         return;
    694     }
    695     do {
    696         for (i = 0; i < QHT_BUCKET_ENTRIES; i++) {
    697             if (b->pointers[i]) {
    698                 continue;
    699             }
    700             if (i > 0) {
    701                 return qht_entry_move(orig, pos, b, i - 1);
    702             }
    703             qht_debug_assert(prev);
    704             return qht_entry_move(orig, pos, prev, QHT_BUCKET_ENTRIES - 1);
    705         }
    706         prev = b;
    707         b = b->next;
    708     } while (b);
    709     /* no free entries other than orig[pos], so swap it with the last one */
    710     qht_entry_move(orig, pos, prev, QHT_BUCKET_ENTRIES - 1);
    711 }
    712 
    713 /* call with b->lock held */
    714 static inline
    715 bool qht_remove__locked(struct qht_bucket *head, const void *p, uint32_t hash)
    716 {
    717     struct qht_bucket *b = head;
    718     int i;
    719 
    720     do {
    721         for (i = 0; i < QHT_BUCKET_ENTRIES; i++) {
    722             void *q = b->pointers[i];
    723 
    724             if (unlikely(q == NULL)) {
    725                 return false;
    726             }
    727             if (q == p) {
    728                 qht_debug_assert(b->hashes[i] == hash);
    729                 seqlock_write_begin(&head->sequence);
    730                 qht_bucket_remove_entry(b, i);
    731                 seqlock_write_end(&head->sequence);
    732                 return true;
    733             }
    734         }
    735         b = b->next;
    736     } while (b);
    737     return false;
    738 }
    739 
    740 bool qht_remove(struct qht *ht, const void *p, uint32_t hash)
    741 {
    742     struct qht_bucket *b;
    743     struct qht_map *map;
    744     bool ret;
    745 
    746     /* NULL pointers are not supported */
    747     qht_debug_assert(p);
    748 
    749     b = qht_bucket_lock__no_stale(ht, hash, &map);
    750     ret = qht_remove__locked(b, p, hash);
    751     qht_bucket_debug__locked(b);
    752     qemu_spin_unlock(&b->lock);
    753     return ret;
    754 }
    755 
    756 static inline void qht_bucket_iter(struct qht_bucket *head,
    757                                    const struct qht_iter *iter, void *userp)
    758 {
    759     struct qht_bucket *b = head;
    760     int i;
    761 
    762     do {
    763         for (i = 0; i < QHT_BUCKET_ENTRIES; i++) {
    764             if (b->pointers[i] == NULL) {
    765                 return;
    766             }
    767             switch (iter->type) {
    768             case QHT_ITER_VOID:
    769                 iter->f.retvoid(b->pointers[i], b->hashes[i], userp);
    770                 break;
    771             case QHT_ITER_RM:
    772                 if (iter->f.retbool(b->pointers[i], b->hashes[i], userp)) {
    773                     /* replace i with the last valid element in the bucket */
    774                     seqlock_write_begin(&head->sequence);
    775                     qht_bucket_remove_entry(b, i);
    776                     seqlock_write_end(&head->sequence);
    777                     qht_bucket_debug__locked(b);
    778                     /* reevaluate i, since it just got replaced */
    779                     i--;
    780                     continue;
    781                 }
    782                 break;
    783             default:
    784                 g_assert_not_reached();
    785             }
    786         }
    787         b = b->next;
    788     } while (b);
    789 }
    790 
    791 /* call with all of the map's locks held */
    792 static inline void qht_map_iter__all_locked(struct qht_map *map,
    793                                             const struct qht_iter *iter,
    794                                             void *userp)
    795 {
    796     size_t i;
    797 
    798     for (i = 0; i < map->n_buckets; i++) {
    799         qht_bucket_iter(&map->buckets[i], iter, userp);
    800     }
    801 }
    802 
    803 static inline void
    804 do_qht_iter(struct qht *ht, const struct qht_iter *iter, void *userp)
    805 {
    806     struct qht_map *map;
    807 
    808     map = qatomic_rcu_read(&ht->map);
    809     qht_map_lock_buckets(map);
    810     qht_map_iter__all_locked(map, iter, userp);
    811     qht_map_unlock_buckets(map);
    812 }
    813 
    814 void qht_iter(struct qht *ht, qht_iter_func_t func, void *userp)
    815 {
    816     const struct qht_iter iter = {
    817         .f.retvoid = func,
    818         .type = QHT_ITER_VOID,
    819     };
    820 
    821     do_qht_iter(ht, &iter, userp);
    822 }
    823 
    824 void qht_iter_remove(struct qht *ht, qht_iter_bool_func_t func, void *userp)
    825 {
    826     const struct qht_iter iter = {
    827         .f.retbool = func,
    828         .type = QHT_ITER_RM,
    829     };
    830 
    831     do_qht_iter(ht, &iter, userp);
    832 }
    833 
    834 struct qht_map_copy_data {
    835     struct qht *ht;
    836     struct qht_map *new;
    837 };
    838 
    839 static void qht_map_copy(void *p, uint32_t hash, void *userp)
    840 {
    841     struct qht_map_copy_data *data = userp;
    842     struct qht *ht = data->ht;
    843     struct qht_map *new = data->new;
    844     struct qht_bucket *b = qht_map_to_bucket(new, hash);
    845 
    846     /* no need to acquire b->lock because no thread has seen this map yet */
    847     qht_insert__locked(ht, new, b, p, hash, NULL);
    848 }
    849 
    850 /*
    851  * Atomically perform a resize and/or reset.
    852  * Call with ht->lock held.
    853  */
    854 static void qht_do_resize_reset(struct qht *ht, struct qht_map *new, bool reset)
    855 {
    856     struct qht_map *old;
    857     const struct qht_iter iter = {
    858         .f.retvoid = qht_map_copy,
    859         .type = QHT_ITER_VOID,
    860     };
    861     struct qht_map_copy_data data;
    862 
    863     old = ht->map;
    864     qht_map_lock_buckets(old);
    865 
    866     if (reset) {
    867         qht_map_reset__all_locked(old);
    868     }
    869 
    870     if (new == NULL) {
    871         qht_map_unlock_buckets(old);
    872         return;
    873     }
    874 
    875     g_assert(new->n_buckets != old->n_buckets);
    876     data.ht = ht;
    877     data.new = new;
    878     qht_map_iter__all_locked(old, &iter, &data);
    879     qht_map_debug__all_locked(new);
    880 
    881     qatomic_rcu_set(&ht->map, new);
    882     qht_map_unlock_buckets(old);
    883     call_rcu(old, qht_map_destroy, rcu);
    884 }
    885 
    886 bool qht_resize(struct qht *ht, size_t n_elems)
    887 {
    888     size_t n_buckets = qht_elems_to_buckets(n_elems);
    889     size_t ret = false;
    890 
    891     qht_lock(ht);
    892     if (n_buckets != ht->map->n_buckets) {
    893         struct qht_map *new;
    894 
    895         new = qht_map_create(n_buckets);
    896         qht_do_resize(ht, new);
    897         ret = true;
    898     }
    899     qht_unlock(ht);
    900 
    901     return ret;
    902 }
    903 
    904 /* pass @stats to qht_statistics_destroy() when done */
    905 void qht_statistics_init(const struct qht *ht, struct qht_stats *stats)
    906 {
    907     const struct qht_map *map;
    908     int i;
    909 
    910     map = qatomic_rcu_read(&ht->map);
    911 
    912     stats->used_head_buckets = 0;
    913     stats->entries = 0;
    914     qdist_init(&stats->chain);
    915     qdist_init(&stats->occupancy);
    916     /* bail out if the qht has not yet been initialized */
    917     if (unlikely(map == NULL)) {
    918         stats->head_buckets = 0;
    919         return;
    920     }
    921     stats->head_buckets = map->n_buckets;
    922 
    923     for (i = 0; i < map->n_buckets; i++) {
    924         const struct qht_bucket *head = &map->buckets[i];
    925         const struct qht_bucket *b;
    926         unsigned int version;
    927         size_t buckets;
    928         size_t entries;
    929         int j;
    930 
    931         do {
    932             version = seqlock_read_begin(&head->sequence);
    933             buckets = 0;
    934             entries = 0;
    935             b = head;
    936             do {
    937                 for (j = 0; j < QHT_BUCKET_ENTRIES; j++) {
    938                     if (qatomic_read(&b->pointers[j]) == NULL) {
    939                         break;
    940                     }
    941                     entries++;
    942                 }
    943                 buckets++;
    944                 b = qatomic_rcu_read(&b->next);
    945             } while (b);
    946         } while (seqlock_read_retry(&head->sequence, version));
    947 
    948         if (entries) {
    949             qdist_inc(&stats->chain, buckets);
    950             qdist_inc(&stats->occupancy,
    951                       (double)entries / QHT_BUCKET_ENTRIES / buckets);
    952             stats->used_head_buckets++;
    953             stats->entries += entries;
    954         } else {
    955             qdist_inc(&stats->occupancy, 0);
    956         }
    957     }
    958 }
    959 
    960 void qht_statistics_destroy(struct qht_stats *stats)
    961 {
    962     qdist_destroy(&stats->occupancy);
    963     qdist_destroy(&stats->chain);
    964 }