Method push

pose_graph/include/utils/ThreadSafeQueue.h:273–285

template <typename T>
bool ThreadsafeQueue<T>::push(T new_value) {
  if (shutdown_) return false;  // atomic, no lock needed.
  std::shared_ptr<T> data(std::make_shared<T>(std::move(new_value)));
  std::unique_lock<std::mutex> lk(mutex_);
  data_queue_.push(data);
  size_t queue_size = data_queue_.size();
  lk.unlock();  // Unlock before notify.
  data_cond_.notify_one();
  // Thread-safe so doesn't need external mutex.
  if (queue_size_stats_) queue_size_stats_->AddSample(queue_size);
  VLOG_IF(1, queue_size > 1u) << "Queue with id: " << queue_id_ << " is getting full, size: " << queue_size;
  return true;
}

template <typename T>
bool ThreadsafeQueue<T>::pushBlockingIfFull(T new_value, size_t max_queue_size) {