Добавить в стек среднее арифметическое элементов не нарушая упорядоченности

#include <iostream>
#include <stack>
using namespace std;
int main()
{
    stack<double> S1,S2;
    for(double a=1.0;a<=2.;a+=0.1) // заполнение стека
        S1.push(a);
    double average=0;
    int N=S1.size();    // количество элементов в стеке
    while(!S1.empty())
    {
        average+=S1.top(); // суммирование содержимого стека
        S2.push(S1.top());  // перенос содержимого в другой стек
        S1.pop();
    }
    average/=N;    // среднее
    while(S2.top()<average)
    {
        S1.push(S2.top()); // перенос содержимого в исходный стек до значения меньшего среднего
        S2.pop();
    }
    S1.push(average); // занесение в стек среднего
    while(!S2.empty()) // перенос остатка в исходный стек
    {
        S1.push(S2.top());
        S2.pop();
    }
    while(!S1.empty())
    {
        cout<<S1.top()<<' '; // вывод содержимого стека
        S1.pop();
    }
    cout<<endl;
    system("pause");
    return 0;
}

#include <iostream>
#include <stack>
#include <vector>
#include <algorithm>
#include <numeric>
 
int main()
{
    std::stack<double, std::vector<double>> st;
    st.push(1.6);
    st.push(2.6);
    st.push(3.5);
    st.push(4.6);
    
    double *end = (&st.top())+1;
    double *begin = end-st.size();
    
    double mid = std::accumulate(begin, end, 0.0)/st.size();
    st.push(mid);
    end = (&st.top())+1;
    begin = end-st.size();
    std::sort(begin, end);
    
    while(!st.empty())
    {
        std::cout << st.top() << std::endl;
        st.pop();
    }
}