Добавить в очередь среднее арифметическое элементов очереди, не нарушая упорядоченности.(подключать <queue> нельзя)

#include <iostream>
 
template<size_t SIZE>
class Queue {
public:
    bool add(double value) {
        if (_size >= SIZE) {
            return false;
        }
        
        _data[_write_index] = value;
        _size++;
        _write_index = (_write_index + 1) % SIZE;
        
        return true;
    }
    
    bool get(double& value) {
        if (_size == 0) {
            return false;
        }
        
        value = _data[_read_index];
        _size--;
        _read_index = (_read_index + 1) % SIZE;
        
        return true;
    }
    
    size_t size() {
        return _size;
    }
    
    bool full() {
        return _size == SIZE;
    }
    
private:
    double _data[SIZE];
    size_t _size{0};
    int _read_index{0};
    int _write_index{0};
};
 
template<size_t SIZE>
void insert(Queue<SIZE>& q) {
    Queue<SIZE> q2;
    double t;
    double sum = 0;
    double new_value;
    
    while(q.get(t)) {
        sum += t;
        q2.add(t);
    }
    new_value = sum / q2.size();
    
    while(q2.get(t)) {
        if (t < new_value) {
            q.add(t);
        } else {
            q.add(new_value);
            q.add(t);
            break;
        }
    }
    
    while (q2.get(t)) {
        q.add(t);
    }
}
 
int main() {
    Queue<10> q;
    
    if (!q.full()) {
        insert(q);
    }
    
    return 0;
}