Поиск и замена в строке items подстрок subStr на fStr - C (СИ)

#include <iostream>
 
/*Поиск и замена в строке items подстрок subStr на fStr
и возвращение указателя на новую строку.*/
char* Replace(char* items, char* subStr, char* fStr)
{
    size_t count = 0;   //Счетчик для посчета совпадений в строке.
    char *p1, *p2;      //Временные указатели (для копирования строк).
    char* newStr;       //Указатель на новую строку.
 
    for (size_t i = 0; items[i]; i++)
    {
        //Выставить указатели на начало входящей строки и новой строки.
        p1 = &items[i];
        p2 = subStr;
 
        //Сравниваем заменяемую последовательность с заменяемой.
        while(*p2 && *p2 == *p1)
        {
            p1++;
            p2++;
        }
 
        //Инкремент счетчика совпадений.
        if (!*p2) count++;
    }

    //Выделяем новый блок памяти для новой строки.
    size_t newLength = \
        (strlen(items) - strlen(subStr) * count) + strlen(fStr) * count + 1;
    newStr = (char*)malloc(newLength * sizeof(char));
    memset(newStr, '\0', newLength);
 
    //count теперь указывает на индекс в новой строке.
    count = 0;
    for (size_t i = 0; items[i]; i++)
    {
        p1 = &items[i];
        p2 = subStr;
 
        while(*p2 && *p2 == *p1)
        {
            p1++;
            p2++;
        }
        /*Если не нашло совпадение копирует сивол входящей строки
        в новою строку. Если нашло совпадение копирует заменяющую
        (fStr) строку в конец новой(newStr) строки*/
        if (!*p2)
        {
            p1 = &newStr[count];
            p2 = fStr;
 
            while(*p2)
            {
                *p1++ = *p2++;
                count++;
            }
 
            i += strlen(subStr) - 1;
        }
        else
        {
            p1 = &items[i];
            p2 = &newStr[count];
            *p2 = *p1;
            count++;
        }
    }
 
    return newStr;
}