xref: /openbmc/sdbusplus/include/sdbusplus/async/stdexec/__detail/__intrusive_ptr.hpp (revision 06f265f6)

/*
 * Copyright (c) 2022 NVIDIA Corporation
 *
 * Licensed under the Apache License Version 2.0 with LLVM Exceptions
 * (the "License"); you may not use this file except in compliance with
 * the License. You may obtain a copy of the License at
 *
 *   https://llvm.org/LICENSE.txt
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */
#pragma once

#include "__concepts.hpp"
#include "__meta.hpp"

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

#if STDEXEC_TSAN()
#include <sanitizer/tsan_interface.h>
#endif

namespace stdexec
{
namespace __ptr
{
template <std::size_t _ReservedBits>
struct __count_and_bits
{
    static constexpr std::size_t __ref_count_increment = 1ul << _ReservedBits;

    enum struct __bits : std::size_t
    {
    };

    friend constexpr std::size_t __count(__bits __b) noexcept
    {
        return static_cast<std::size_t>(__b) / __ref_count_increment;
    }

    template <std::size_t _Bit>
    friend constexpr bool __bit(__bits __b) noexcept
    {
        static_assert(_Bit < _ReservedBits, "Bit index out of range");
        return (static_cast<std::size_t>(__b) & (1ul << _Bit)) != 0;
    }
};

template <std::size_t _ReservedBits>
using __bits_t = typename __count_and_bits<_ReservedBits>::__bits;

template <class _Ty, std::size_t _ReservedBits>
struct __make_intrusive_t;

template <class _Ty, std::size_t _ReservedBits = 0ul>
class __intrusive_ptr;

template <class _Ty, std::size_t _ReservedBits = 0ul>
struct __enable_intrusive_from_this
{
    auto
        __intrusive_from_this() noexcept -> __intrusive_ptr<_Ty, _ReservedBits>;
    auto __intrusive_from_this() const noexcept
        -> __intrusive_ptr<const _Ty, _ReservedBits>;

  private:
    using __bits_t = typename __count_and_bits<_ReservedBits>::__bits;
    friend _Ty;
    __bits_t __inc_ref() noexcept;
    __bits_t __dec_ref() noexcept;

    template <std::size_t _Bit>
    bool __is_set() const noexcept;
    template <std::size_t _Bit>
    __bits_t __set_bit() noexcept;
    template <std::size_t _Bit>
    __bits_t __clear_bit() noexcept;
};

STDEXEC_PRAGMA_PUSH()
STDEXEC_PRAGMA_IGNORE_GNU("-Wtsan")

template <class _Ty, std::size_t _ReservedBits>
struct __control_block
{
    using __bits_t = typename __count_and_bits<_ReservedBits>::__bits;
    static constexpr std::size_t __ref_count_increment = 1ul << _ReservedBits;

    alignas(_Ty) unsigned char __value_[sizeof(_Ty)];
    std::atomic<std::size_t> __ref_count_;

    template <class... _Us>
    explicit __control_block(_Us&&... __us) noexcept(noexcept(_Ty{
        __declval<_Us>()...})) : __ref_count_(__ref_count_increment)
    {
        // Construct the value *after* the initialization of the atomic in case
        // the constructor of _Ty calls __intrusive_from_this() (which
        // increments the ref count):
        ::new (static_cast<void*>(__value_)) _Ty{static_cast<_Us&&>(__us)...};
    }

    ~__control_block()
    {
        __value().~_Ty();
    }

    auto __value() noexcept -> _Ty&
    {
        return *reinterpret_cast<_Ty*>(__value_);
    }

    __bits_t __inc_ref_() noexcept
    {
        auto __old = __ref_count_.fetch_add(__ref_count_increment,
                                            std::memory_order_relaxed);
        return static_cast<__bits_t>(__old);
    }

    __bits_t __dec_ref_() noexcept
    {
        auto __old = __ref_count_.fetch_sub(__ref_count_increment,
                                            std::memory_order_acq_rel);
        if (__count(static_cast<__bits_t>(__old)) == 1)
        {
            delete this;
        }
        return static_cast<__bits_t>(__old);
    }

    // Returns true if the bit was set, false if it was already set.
    template <std::size_t _Bit>
    [[nodiscard]] bool __is_set_() const noexcept
    {
        auto __old = __ref_count_.load(std::memory_order_relaxed);
        return __bit<_Bit>(static_cast<__bits_t>(__old));
    }

    template <std::size_t _Bit>
    __bits_t __set_bit_() noexcept
    {
        static_assert(_Bit < _ReservedBits, "Bit index out of range");
        constexpr std::size_t __mask = 1ul << _Bit;
        auto __old = __ref_count_.fetch_or(__mask, std::memory_order_acq_rel);
        return static_cast<__bits_t>(__old);
    }

    // Returns true if the bit was cleared, false if it was already cleared.
    template <std::size_t _Bit>
    __bits_t __clear_bit_() noexcept
    {
        static_assert(_Bit < _ReservedBits, "Bit index out of range");
        constexpr std::size_t __mask = 1ul << _Bit;
        auto __old = __ref_count_.fetch_and(~__mask, std::memory_order_acq_rel);
        return static_cast<__bits_t>(__old);
    }
};

STDEXEC_PRAGMA_POP()

template <class _Ty, std::size_t _ReservedBits /* = 0ul */>
class __intrusive_ptr
{
    using _UncvTy = std::remove_cv_t<_Ty>;
    using __enable_intrusive_t =
        __enable_intrusive_from_this<_UncvTy, _ReservedBits>;
    friend _Ty;
    friend struct __make_intrusive_t<_Ty, _ReservedBits>;
    friend struct __enable_intrusive_from_this<_UncvTy, _ReservedBits>;

    __control_block<_UncvTy, _ReservedBits>* __data_{nullptr};

    explicit __intrusive_ptr(
        __control_block<_UncvTy, _ReservedBits>* __data) noexcept :
        __data_(__data)
    {}

    void __inc_ref_() noexcept
    {
        if (__data_)
        {
            __data_->__inc_ref_();
        }
    }

    void __dec_ref_() noexcept
    {
        if (__data_)
        {
            __data_->__dec_ref_();
        }
    }

    // For use when types want to take over manual control of the reference
    // count. Very unsafe, but useful for implementing custom reference
    // counting.
    [[nodiscard]] __enable_intrusive_t* __release_() noexcept
    {
        auto* __data = std::exchange(__data_, nullptr);
        return __data ? &__c_upcast<__enable_intrusive_t>(__data->__value())
                      : nullptr;
    }

  public:
    using element_type = _Ty;

    __intrusive_ptr() = default;

    __intrusive_ptr(__intrusive_ptr&& __that) noexcept :
        __data_(std::exchange(__that.__data_, nullptr))
    {}

    __intrusive_ptr(const __intrusive_ptr& __that) noexcept :
        __data_(__that.__data_)
    {
        __inc_ref_();
    }

    __intrusive_ptr(
        __enable_intrusive_from_this<_Ty, _ReservedBits>* __that) noexcept :
        __intrusive_ptr(
            __that ? __that->__intrusive_from_this() : __intrusive_ptr())
    {}

    auto operator=(__intrusive_ptr&& __that) noexcept -> __intrusive_ptr&
    {
        [[maybe_unused]] __intrusive_ptr __old{
            std::exchange(__data_, std::exchange(__that.__data_, nullptr))};
        return *this;
    }

    auto operator=(const __intrusive_ptr& __that) noexcept -> __intrusive_ptr&
    {
        return operator=(__intrusive_ptr(__that));
    }

    auto operator=(__enable_intrusive_from_this<_Ty, _ReservedBits>*
                       __that) noexcept -> __intrusive_ptr&
    {
        return operator=(
            __that ? __that->__intrusive_from_this() : __intrusive_ptr());
    }

    ~__intrusive_ptr()
    {
        __dec_ref_();
    }

    void reset() noexcept
    {
        operator=({});
    }

    void swap(__intrusive_ptr& __that) noexcept
    {
        std::swap(__data_, __that.__data_);
    }

    auto get() const noexcept -> _Ty*
    {
        return &__data_->__value();
    }

    auto operator->() const noexcept -> _Ty*
    {
        return &__data_->__value();
    }

    auto operator*() const noexcept -> _Ty&
    {
        return __data_->__value();
    }

    explicit operator bool() const noexcept
    {
        return __data_ != nullptr;
    }

    auto operator!() const noexcept -> bool
    {
        return __data_ == nullptr;
    }

    auto operator==(const __intrusive_ptr&) const -> bool = default;

    auto operator==(std::nullptr_t) const noexcept -> bool
    {
        return __data_ == nullptr;
    }
};

template <class _Ty, std::size_t _ReservedBits>
auto __enable_intrusive_from_this<
    _Ty, _ReservedBits>::__intrusive_from_this() noexcept
    -> __intrusive_ptr<_Ty, _ReservedBits>
{
    auto* __data = reinterpret_cast<__control_block<_Ty, _ReservedBits>*>(
        &__c_downcast<_Ty>(*this));
    __data->__inc_ref_();
    return __intrusive_ptr<_Ty, _ReservedBits>{__data};
}

template <class _Ty, std::size_t _ReservedBits>
auto __enable_intrusive_from_this<_Ty, _ReservedBits>::__intrusive_from_this()
    const noexcept -> __intrusive_ptr<const _Ty, _ReservedBits>
{
    auto* __data = reinterpret_cast<__control_block<_Ty, _ReservedBits>*>(
        &__c_downcast<_Ty>(*this));
    __data->__inc_ref_();
    return __intrusive_ptr<const _Ty, _ReservedBits>{__data};
}

template <class _Ty, std::size_t _ReservedBits>
__bits_t<_ReservedBits>
    __enable_intrusive_from_this<_Ty, _ReservedBits>::__inc_ref() noexcept
{
    auto* __data = reinterpret_cast<__control_block<_Ty, _ReservedBits>*>(
        &__c_downcast<_Ty>(*this));
    return __data->__inc_ref_();
}

template <class _Ty, std::size_t _ReservedBits>
__bits_t<_ReservedBits>
    __enable_intrusive_from_this<_Ty, _ReservedBits>::__dec_ref() noexcept
{
    auto* __data = reinterpret_cast<__control_block<_Ty, _ReservedBits>*>(
        &__c_downcast<_Ty>(*this));
    return __data->__dec_ref_();
}

template <class _Ty, std::size_t _ReservedBits>
template <std::size_t _Bit>
bool __enable_intrusive_from_this<_Ty, _ReservedBits>::__is_set() const noexcept
{
    auto* __data = reinterpret_cast<const __control_block<_Ty, _ReservedBits>*>(
        &__c_downcast<_Ty>(*this));
    return __data->template __is_set_<_Bit>();
}

template <class _Ty, std::size_t _ReservedBits>
template <std::size_t _Bit>
__bits_t<_ReservedBits>
    __enable_intrusive_from_this<_Ty, _ReservedBits>::__set_bit() noexcept
{
    auto* __data = reinterpret_cast<__control_block<_Ty, _ReservedBits>*>(
        &__c_downcast<_Ty>(*this));
    return __data->template __set_bit_<_Bit>();
}

template <class _Ty, std::size_t _ReservedBits>
template <std::size_t _Bit>
__bits_t<_ReservedBits>
    __enable_intrusive_from_this<_Ty, _ReservedBits>::__clear_bit() noexcept
{
    auto* __data = reinterpret_cast<__control_block<_Ty, _ReservedBits>*>(
        &__c_downcast<_Ty>(*this));
    return __data->template __clear_bit_<_Bit>();
}

template <class _Ty, std::size_t _ReservedBits>
struct __make_intrusive_t
{
    template <class... _Us>
        requires constructible_from<_Ty, _Us...>
    auto operator()(_Us&&... __us) const -> __intrusive_ptr<_Ty, _ReservedBits>
    {
        using _UncvTy = std::remove_cv_t<_Ty>;
        return __intrusive_ptr<_Ty, _ReservedBits>{
            ::new __control_block<_UncvTy, _ReservedBits>{
                static_cast<_Us&&>(__us)...}};
    }
};
} // namespace __ptr

using __ptr::__enable_intrusive_from_this;
using __ptr::__intrusive_ptr;
template <class _Ty, std::size_t _ReservedBits = 0ul>
inline constexpr __ptr::__make_intrusive_t<_Ty, _ReservedBits>
    __make_intrusive{};

} // namespace stdexec