c言語　自作シェルで「jobs」の実行

###前提・実現したいこと
c言語で自作シェルを作っています.
「jobs]と「fg」コマンドを実現をしたいです.
jobsとprompt:で入力したときに[通し番号] プロセスIDを表示したいです.

###発生している問題・エラーメッセージ
BG実行中のプロセスの数はp_nで数えているのですが,BGのプロセスを終了してもp_nが減る時と減らないときがあります.

###該当のソースコード
＃include <stdio.h>
＃include <stdlib.h> //exitを使うために取り込む
＃include <unistd.h> //execvとforkを使うために取り込み
＃include <string.h> //strtokとstrcmpを使うために取り込み
＃include <sys/wait.h> //waitpidを使うために取り込み

int main(void) {
pid_t pid; //プロセスの生成
char com[256]; //文字読み込み用
char *argv[256];
char *ptr; //ポインタ
int i,j; //ループ時のカウンタ
char *and; //文字列に＆がなければNULL
char a = '&';
int status;
int p_n = 0; //プロセスの数を数える
int pid_id[256]; //プロセスIDを格納
int p_r = 0; //プロセスID(ループ用)
int fg_id = 0; //入力されたプロセスIDをFG実行
char fg[256]; //入力されたプロセスIDをFG実行
int endpid = 0; //終了したプロセスのプロセスIDを

//whileループ
while(1) {

//プロンプト表示
printf("prompt: ");

//入力読み込み
fgets(com, sizeof(com), stdin);

//入力した文字列に＆がついてるか判断
and = strchr(com, a);

//argv1に上で読み込んだcomを代入
argv[0] = strtok(com, " \n\0");

//判断 exit quitなら終了
if(strcmp(com,"exit") == 0 || strcmp(com,"quit") == 0)
  exit(0); 

//jobs    
if(strcmp(com,"jobs") == 0){

  //BG実行されているプロセスの数だけループを回す
  for(i = 0;i < p_n; i++){

//通し番号の表示
printf("[%d]   ", i+1);

//プロセスIDの表示
printf("%d\n", pid_id[i]);
  }
}

//fg
if(strcmp(com,"fg") == 0){

  //プロセスIDの入力受付
  printf("FG実行したいプロセスのプロセスIDを入力してください:");
  fgets(fg, sizeof(fg), stdin);       //プロセスIDを文字列として読み込む
  fg_id = atoi(fg);                   //int型に変換

  //入力されたプロセスIDが子プロセスを待つ(FG実行)
  waitpid(fg_id, &status, 0);

  continue;

} 

//ループさせてポインタを動かす
//strtokを使い空白とエンターで分解
//ポインタを使い分解したものを配列に入れていく
for(i = 1; i < 256; i++) {
  ptr = strtok(NULL, " &\n\0");
  argv[i] = ptr;

  //文字列が分解し終わったらループを抜け出す
  if (ptr == NULL)
break;
}

//分裂(fork) 新しいプロセスをつくる
pid = fork();

//プロセスIDをpid_idに格納
pid_id[p_r] = pid;
p_r++;

//プロセス作成に失敗したときは、0未満を返す
if(pid < 0) {
  printf("error\n");
  exit(-1);
}

//親と子の判断
//子プロセス
//子プロセス読み込んだコマンドを実行(execv)
//exitで抜け出す
if(pid == 0) {
  execv(argv[0], argv);
  exit(0);
} 

//親プロセス
if(pid > 0) {
  if(and == NULL){                      //andがNULLの時(&がない時)
waitpid(pid, &status, 0);           //親プロセス待機（子プロセス終了待ち) 
  }else{                                //andがNULLじゃないとき(&があるとき)
waitpid(pid, &status, WNOHANG);
p_n++; 
  }
}

//終了したプロセスのプロセスIDを取得
endpid = waitpid(-1, &status, WNOHANG);
if(endpid > 0) {
for(i = 0; i < p_n; i++){
if(endpid == pid_id[i]){
for(j = i; j < p_n+1; j++)
pid_id[i] = pid_id[i+1];
p_n--;
}
}
continue;
}