129 lines
3.1 KiB
C++
129 lines
3.1 KiB
C++
#pragma once
|
|
|
|
#include <chrono>
|
|
#include <condition_variable>
|
|
#include <cstddef>
|
|
#include <deque>
|
|
#include <mutex>
|
|
#include <utility>
|
|
|
|
namespace rk3588 {
|
|
|
|
enum class QueueDropStrategy {
|
|
DropOldest,
|
|
DropNewest,
|
|
Block
|
|
};
|
|
|
|
template <typename T>
|
|
class SpscQueue {
|
|
public:
|
|
struct Stats {
|
|
size_t size = 0;
|
|
size_t capacity = 0;
|
|
size_t dropped = 0;
|
|
size_t pushed = 0;
|
|
size_t popped = 0;
|
|
bool stopped = false;
|
|
};
|
|
|
|
SpscQueue(size_t capacity, QueueDropStrategy strategy)
|
|
: capacity_(capacity), strategy_(strategy) {}
|
|
|
|
bool Push(T item) {
|
|
std::unique_lock<std::mutex> lock(mu_);
|
|
if (stop_) return false;
|
|
if (queue_.size() >= capacity_) {
|
|
if (strategy_ == QueueDropStrategy::DropOldest) {
|
|
queue_.pop_front();
|
|
++dropped_;
|
|
} else if (strategy_ == QueueDropStrategy::DropNewest) {
|
|
// Drop the incoming item.
|
|
++dropped_;
|
|
return true;
|
|
} else {
|
|
// Block until space is available
|
|
space_cv_.wait(lock, [&] { return queue_.size() < capacity_ || stop_; });
|
|
if (stop_) return false;
|
|
}
|
|
}
|
|
queue_.push_back(std::move(item));
|
|
++pushed_;
|
|
data_cv_.notify_one();
|
|
return true;
|
|
}
|
|
|
|
bool Pop(T& out, std::chrono::milliseconds timeout) {
|
|
std::unique_lock<std::mutex> lock(mu_);
|
|
if (!data_cv_.wait_for(lock, timeout, [&] { return !queue_.empty() || stop_; })) {
|
|
return false;
|
|
}
|
|
if (queue_.empty()) return false;
|
|
out = std::move(queue_.front());
|
|
queue_.pop_front();
|
|
++popped_;
|
|
space_cv_.notify_one();
|
|
return true;
|
|
}
|
|
|
|
void Stop() {
|
|
std::lock_guard<std::mutex> lock(mu_);
|
|
stop_ = true;
|
|
data_cv_.notify_all();
|
|
space_cv_.notify_all();
|
|
}
|
|
|
|
bool IsStopped() const {
|
|
std::lock_guard<std::mutex> lock(mu_);
|
|
return stop_;
|
|
}
|
|
|
|
size_t Size() const {
|
|
std::lock_guard<std::mutex> lock(mu_);
|
|
return queue_.size();
|
|
}
|
|
|
|
size_t Capacity() const { return capacity_; }
|
|
|
|
size_t DroppedCount() const {
|
|
std::lock_guard<std::mutex> lock(mu_);
|
|
return dropped_;
|
|
}
|
|
|
|
size_t PushedCount() const {
|
|
std::lock_guard<std::mutex> lock(mu_);
|
|
return pushed_;
|
|
}
|
|
|
|
size_t PoppedCount() const {
|
|
std::lock_guard<std::mutex> lock(mu_);
|
|
return popped_;
|
|
}
|
|
|
|
Stats GetStats() const {
|
|
std::lock_guard<std::mutex> lock(mu_);
|
|
Stats s;
|
|
s.size = queue_.size();
|
|
s.capacity = capacity_;
|
|
s.dropped = dropped_;
|
|
s.pushed = pushed_;
|
|
s.popped = popped_;
|
|
s.stopped = stop_;
|
|
return s;
|
|
}
|
|
|
|
private:
|
|
size_t capacity_ = 0;
|
|
QueueDropStrategy strategy_ = QueueDropStrategy::DropOldest;
|
|
mutable std::mutex mu_;
|
|
std::condition_variable data_cv_;
|
|
std::condition_variable space_cv_;
|
|
std::deque<T> queue_;
|
|
bool stop_ = false;
|
|
size_t dropped_ = 0;
|
|
size_t pushed_ = 0;
|
|
size_t popped_ = 0;
|
|
};
|
|
|
|
} // namespace rk3588
|