GFFQueue3.hpp

#pragma once

#include <atomic>
#include <array>
#include <cstddef>
#include <new>
#include <type_traits>

template<typename T, std::size_t SIZE>
struct alignas(64) GFFQueue3 {
    using value_type = T;

    struct node {
        std::atomic_bool occupied;
        alignas(alignof(T)) std::array<std::byte, sizeof(T)> storage;
    };

    alignas(64) std::size_t tail{ 0 };
    alignas(64) std::size_t head{ 0 };
    alignas(64) std::array<node, SIZE> buffer;

    template<typename... Args>
    int Enqueue(Args&&... args) {
        size_t t = tail;
        node& n = buffer[t];
        if (n.occupied) return 0;
        new(n.storage.data()) T(std::forward<Args>(args)...);
        n.occupied = true;
        t += 1;
        if (t == SIZE) t = 0;
        tail = t;
        return 1;
    }

    template<typename Callable>
    int Dequeue(Callable&& f) {
        size_t h = head;
        node& n = buffer[h];
        if (n.occupied == false) return 0;
        T* elem = std::launder(reinterpret_cast<T*>(n.storage.data()));
        std::invoke(std::forward<Callable>(f), std::move(*elem));
        elem->~T();
        n.occupied = false;
        h += 1;
        if (h == SIZE) h = 0;
        head = h;
        return 1;
    }
};