Увеличить все серии массива наибольшей длины на один элемент

#include <iostream>
#include <vector>
#include <algorithm>
#include <iterator>
 
int
max_sequence(const std::vector<int>& data) {
    int sequence_maxsize = 0;
    int sequence_size = 0;
    
    for (int i = 0; i < data.size(); i++) {
        sequence_size++;
        if ((i == data.size() - 1) || (data[i] != data[i + 1])) {
            if (sequence_size > sequence_maxsize) {
                sequence_maxsize = sequence_size;
            }
            sequence_size = 0;
        }
    }
    
    return sequence_maxsize;
}
 
void
expansion_sequence(std::vector<int>& data) {
    int sequence_maxsize = max_sequence(data);
    int sequence_size = 0;
    
    for (int i = 0; i < data.size(); i++) {
        sequence_size++;
        if ((i == data.size() - 1) || (data[i] != data[i + 1])) {
            if (sequence_size == sequence_maxsize) {
                data.insert(data.begin() + i, data[i]);
                i++;
            }
            sequence_size = 0;
        }
    }
}
 
int
main() {
    std::vector<int> data = {
        1, 2, 3, 4, 5
    };
    
    expansion_sequence(data);
    std::copy(data.begin(), data.end(),
            std::ostream_iterator<int>(std::cout, " "));
    
    return 0;
}