嵌入式c语言，计算字符串中子串出现的次数。

#include <stdio.h>
int main(int argc, const char * argv[]) {
    char str1[20],str2[20],*p1,*p2;
    int sum=0;
    printf("请输入两个字符串：");
    scanf("%s%s",str1,str2);
    p1=str1;p2=str2;
    while(*p1!='\0')
    {
        if(*p1 == *p2){
            while(*p1 == *p2 && *p2 != '\0'){
                p1++;
                p2++;
            }
        }
        else
            p1++;
        if(*p2=='\0')
            sum++;
        p2=str2;
    }
    printf("s2在s1中一共出现了%d次",sum);
    return 0;
}