int simplest_udp_parser(int port)

{

WSADATA wsaData;

WORD sockVersion = MAKEWORD(2,2);

int cnt=0;

//FILE *myout=fopen("output_log.txt","wb+");

FILE *myout=stdout;

FILE *fp1=fopen("output_dump.ts","wb+");

if(WSAStartup(sockVersion, &wsaData) != 0){

return 0;

}

SOCKET serSocket = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP); 

if(serSocket == INVALID_SOCKET){

printf("socket error !");

return 0;

}

sockaddr_in serAddr;

serAddr.sin_family = AF_INET;

serAddr.sin_port = htons(port);

serAddr.sin_addr.S_un.S_addr = INADDR_ANY;

if(bind(serSocket, (sockaddr *)&serAddr, sizeof(serAddr)) == SOCKET_ERROR){

printf("bind error !");

closesocket(serSocket);

return 0;

}

sockaddr_in remoteAddr;

int nAddrLen = sizeof(remoteAddr); 

//How to parse?

int parse_rtp=1;

int parse_mpegts=1;

printf("Listening on port %d\n",port);

char recvData[10000];  

while (1){

int pktsize = recvfrom(serSocket, recvData, 10000, 0, (sockaddr *)&remoteAddr, &nAddrLen);

if (pktsize > 0){

//printf("Addr:%s\r\n",inet_ntoa(remoteAddr.sin_addr));

//printf("packet size:%d\r\n",pktsize);

//Parse RTP

//

if(parse_rtp!=0){

char payload_str[10]={0};

RTP_FIXED_HEADER rtp_header;

int rtp_header_size=sizeof(RTP_FIXED_HEADER);

//RTP Header

memcpy((void *)&rtp_header,recvData,rtp_header_size);

//RFC3351

char payload=rtp_header.payload;

switch(payload){

case 0:

case 1:

case 2:

case 3:

case 4:

case 5:

case 6:

case 7:

case 8:

case 9:

case 10:

case 11:

case 12:

case 13:

case 14:

case 15:

case 16:

case 17:

case 18: sprintf(payload_str,"Audio");break;

case 31: sprintf(payload_str,"H.261");break;

case 32: sprintf(payload_str,"MPV");break;

case 33: sprintf(payload_str,"MP2T");break;

case 34: sprintf(payload_str,"H.263");break;

case 96: sprintf(payload_str,"H.264");break;

default:sprintf(payload_str,"other");break;

}

unsigned int timestamp=ntohl(rtp_header.timestamp);

unsigned int seq_no=ntohs(rtp_header.seq_no);

fprintf(myout,"[RTP Pkt] %5d| %5s| %10u| %5d| %5d|\n",cnt,payload_str,timestamp,seq_no,pktsize);

//RTP Data

char *rtp_data=recvData+rtp_header_size;

int rtp_data_size=pktsize-rtp_header_size;

fwrite(rtp_data,rtp_data_size,1,fp1);

//Parse MPEGTS

if(parse_mpegts!=0&&payload==33){

MPEGTS_FIXED_HEADER mpegts_header;

for(int i=0;i<rtp_data_size;i=i+188){

if(rtp_data[i]!=0x47)

break;

//MPEGTS Header

//memcpy((void *)&mpegts_header,rtp_data+i,sizeof(MPEGTS_FIXED_HEADER));

fprintf(myout,"   [MPEGTS Pkt]\n");

}

}

}else{

fprintf(myout,"[UDP Pkt] %5d| %5d|\n",cnt,pktsize);

fwrite(recvData,pktsize,1,fp1);

}

cnt++;

}

}

closesocket(serSocket); 

WSACleanup();

fclose(fp1);

return 0;

}