Реализовать функцию INSERT. Не использовать стандартную функцию insert

#include <stdio.h>
 # include <iostream>
#include <cstring>
#include <Windows.h>
using namespace std;
    int Count( char *str, char *subStr)
{
    int res = 0, len;
    if(str && subStr)
    {
        if(len = strlen(subStr))
        {
            for(char  *p = str; *p; p += strncmp(p, subStr, len) ? 1 : (++res, len))
                ;
        }
    }
    return res;
}
 
char*  insert(char* str, char* str1) {
 
 
     char* tmp  = str;
     const char*  ps;
     int   len1, len2, cnt, i;
 
     for(len1 = 0, ps = str1; *ps; *ps++, len1++);
     for(len2 = 0, ps = str;  *ps; *ps++, len2++);
     cnt = len1;
     while(cnt--) {
         for(i = len2+len1; i >= 3; i--)
            *((str) + i + 1) = *((str)+ i);
     }
     str += 3;
     while(*str1)
        *str++ = *str1++;
     return tmp;
}
 
 
 
int main(int argc, char* argv[])
 
{
 
SetConsoleCP(1251);
    SetConsoleOutputCP(1251); 
 char  str[250];
 char  str1[250];
 
    cout<<"Введите 1 строку: ";
    
cin.getline(str, 250,'\n');
 
cout<<"Введите 2 строку: ";
cin.getline(str1, 250,'\n');
 
strncpy (str,str1,3); 
//puts( strncpy ); 
return 0; 
}
  // puts( insert(str, str1, 3) );
  // getchar();
 
  //  return 0;
//}