Задача: Модификация ф-ии strstr, возвращает все вхождения подстроки в строку

#include <iostream>

using namespace std;
//добавление нового элемента в массив
void addElement(int*& ar, int el, int &N)
{
    int* temp = new int [N + 1], t=0;  

    for(int i=0; i<N; i++)
    {
        temp = ar[t];
        ++t;
    }
    temp[N] = el;  

    ++N;
    delete []ar;
    ar = temp; 
}
//cтрока, подстрока, массив индексов, размер массива индексов
void strstr(char* str, char* sub, int*& r, int& r_size)
{
//длина подстр и исх стр, счетчик эл-тов массива индексов и указ на результат
    int sub_l=0, str_l=0, rs=0, *res=0;
   
    while(str[str_l]!='\0') str_l++; //длина исходной строки
    while(sub[sub_l]!='\0') sub_l++; //длина подстроки   

    if(str_l == 1) return; //если 1 эл в строке
    else if(sub_l == 1)//если 1 эл в подстроке
    {
        for(int i = 0; i<str_l; i++)   
            if(sub[0] == str)          
                addElement(res,i,rs);                  
       
        r = res; //возврат массива индексов
        r_size = rs; //размерность массива индексов
        return;
    }

    for(int i=0; i<str_l; i++) 
        if(str==sub[0]) //если совпал символ с первым символом подстроки
        {
            int t = ++i, count=0;
            for(int j=1; j<sub_l; j++) //ищем вхождение
            {
                if(str[t] == sub[j])
                {
                    ++count;
                    if(count == sub_l-1) //если вхождение
             //выделяем ячейку и записываем индекс                  
                        addElement(res,i-1,rs);
                }              
                ++t;
            }
        }
   
    r = res; //возврат массива индексов
    r_size = rs; //размерность массива индексов  
}

int main()
{
    char str[50], sub[50];
    int *r, r_size;

    cout<<"String:"<<endl;
    cin.getline(str,49);

    cout<<"Sub string:"<<endl;
    cin.getline(sub,49);       

    strstr(str,sub,r,r_size);

    for(int i=0; i<r_size; i++) //вывод индексов
        cout<<r<<endl;

        delete []r;

    return 0;
}