//h264视频流打包代码 // NALDecoder.cpp : Defines the entry point for the console application. #include <stdio.h> #include <stdlib.h> #include <string.h> #include <memory.h> #include “h264.h” #include “initsock.h” CInitSock initSock; // 初始化Winsock库 //为NALU_t结构体分配内存空间 NALU_t *AllocNALU(int buffersize) { NALU_t *pNalu; if ((pNalu = (NALU_t*)calloc (1, sizeof (NALU_t))) == NULL) { printf(“AllocNALU: Nalu”); exit(0); } pNalu->max_size=buffersize; if ((pNalu->buf = (char*)calloc (buffersize, sizeof (char))) == NULL) { free (pNalu); printf (“AllocNALU: Nalu->buf”); exit(0); } return pNalu; } //释放 void FreeNALU(NALU_t *pNalu) { if (pNalu) { if (pNalu->buf) { free(pNalu->buf); pNalu->buf=NULL; } free (pNalu); } } static int FindStartCode2 (unsigned char *Buf) { if(Buf[0]!=0 Buf[1]!=0 Buf[2] !=1) return 0; //推断是否为0x000001,假设是返回1 else return 1; } static int FindStartCode3 (unsigned char *Buf) { if(Buf[0]!=0 Buf[1]!=0 Buf[2] !=0 Buf[3] !=1) return 0;//推断是否为0x00000001,假设是返回1 else return 1; } // 这个函数输入为一个NAL结构体。主要功能为得到一个完整的NALU并保存在NALU_t的buf中,获取他的长度。填充F,IDC,TYPE位。 // 而且返回两个開始字符之间间隔的字节数,即包括有前缀的NALU的长度 int GetAnnexbNALU (NALU_t *pNalu, FILE *bits) { int info2=0, info3=0; int pos = 0; int StartCodeFound, rewind; unsigned char *Buf; if ((Buf = (unsigned char*)calloc (pNalu->max_size , sizeof(char))) == NULL) printf (“GetAnnexbNALU: Could not allocate Buf memory\n”); if (3 != fread (Buf, 1, 3, bits)) { //从码流中读3个字节 free(Buf); return -1; } if (Buf[0]!=0 Buf[1]!=0) { free(Buf); return -1; } if (Buf[2]==1) { pNalu->startcodeprefix_len=3; //初始化码流序列的開始字符为3个字节 pos =3; }else { if (1 != fread (Buf+3, 1, 1, bits)) { //从码流中读1个字节 free(Buf); return -1; } if (Buf[2]!=0 Buf[3]!=1) { free(Buf); return -1; } pos = 4; pNalu->startcodeprefix_len = 4; } //查找下一个開始字符的标志位 StartCodeFound = 0; info2 = 0; info3 = 0; while (!StartCodeFound) { if (feof (bits)) { //推断是否到了文件尾 break; } Buf[pos++] = fgetc (bits);//读一个字节到BUF中 info3 = FindStartCode3(&Buf[pos-4]);//推断是否为0x00000001 if(info3 != 1) info2 = FindStartCode2(&Buf[pos-3]);//推断是否为0x000001 StartCodeFound =(info2 info3); } if (StartCodeFound) { // Here, we have found another start code (and read length of startcode bytes more than we should // have. Hence, go back in the file rewind = (info3 == 1)? -4 : -3; if (0 != fseek (bits, rewind, SEEK_CUR)) { // 把文件指针指向前一个NALU的末尾 free(Buf); printf(“GetAnnexbNALU: Cannot fseek in the bit stream file”); } } else { rewind = -1; } // Here the Start code, the complete NALU, and the next start code is in the Buf. // The size of Buf is pos, pos+rewind are the number of bytes excluding the next // start code, and (pos+rewind)-startcodeprefix_len is the size of the NALU excluding the start code pNalu->len = (pos+rewind)-pNalu->startcodeprefix_len; //拷贝一个完整NALU。不拷贝起始前缀0x000001或0x00000001 memcpy (pNalu->buf, &Buf[pNalu->startcodeprefix_len], pNalu->len); pNalu->forbidden_bit = pNalu->buf[0] & 0x80; //1 bit pNalu->nal_reference_idc = pNalu->buf[0] & 0x60; // 2 bit pNalu->nal_unit_type = (pNalu->buf[0]) & 0x1f;// 5 bit free(Buf); return (pos+rewind); //返回两个開始字符之间间隔的字节数,即包括有前缀的NALU的长度 } //输出NALU长度和TYPE void dump(NALU_t *pNalu) { if (!pNalu) return; printf(” len: %d “, pNalu->len); printf(“nal_unit_type: %x\n”, pNalu->nal_unit_type); } int main(int argc, char* argv[]) { NALU_t *pNalu; char* nalu_payload; char sendbuf[1500]; RTP_FIXED_HEADER *rtp_hdr; NALU_HEADER *nalu_hdr; FU_INDICATOR *fu_ind; FU_HEADER *fu_hdr; unsigned short seq_num =0; int bytes=0; FILE *bits; //!< the bit stream file // 打开264文件,在此改动文件名称实现打开别的264文件。 if ((bits=fopen(“./test.264”, “rb”))==NULL) { printf(“open file error\n”); exit(1); } SOCKET socket1; struct sockaddr_in server; int len =sizeof(server); server.sin_family=AF_INET; server.sin_port=htons(DEST_PORT); // 播放器的端口号 server.sin_addr.s_addr=inet_addr(DEST_IP); // 播放器的IP地址 socket1=socket(AF_INET,SOCK_DGRAM,0); // 建立UDP套接字 connect(socket1, (const sockaddr *)&server, len) ; // 与播放器建立连接 float framerate=15; unsigned int timestamp_increse=0, ts_current=0; timestamp_increse=(unsigned int)(90000.0 / framerate); //+0.5); 90000 = ?? pNalu = AllocNALU(8000000);//为结构体nalu_t及其成员buf分配空间。返回值为指向nalu_t存储空间的指针 ?? while(!feof(bits)) { GetAnnexbNALU(pNalu,bits);//每运行一次,文件的指针指向本次找到的NALU的末尾。下一个位置即为下个NALU的起始码0x000001 dump(pNalu); //输出NALU长度和TYPE memset(sendbuf,0,1500);//清空sendbuf;此时会将上次的时间戳清空,因此须要ts_current来保存上次的时间戳值 // rtp固定包头,为12字节,该句将sendbuf[0]的地址赋给rtp_hdr,以后对rtp_hdr的写入操作将直接写入sendbuf。 rtp_hdr =(RTP_FIXED_HEADER*)&sendbuf[0]; //设置RTP HEADER。 rtp_hdr->payload = H264; //负载类型号, rtp_hdr->version = 2; //版本号号。此版本号固定为2 rtp_hdr->marker = 0; //标志位,由详细协议规定其值。 rtp_hdr->ssrc = htonl(10); //随机指定为10,而且在本RTP会话中全局唯一 // 当一个NALU小于1400字节的时候,採用一个单RTP包发送 if(pNalu->len<=1400) { //设置rtp M 位。 rtp_hdr->marker=1; rtp_hdr->seq_no = htons(seq_num ++); //序列号,每发送一个RTP包增1 //设置NALU HEADER,并将这个HEADER填入sendbuf[12] nalu_hdr =(NALU_HEADER*)&sendbuf[12]; //将sendbuf[12]的地址赋给nalu_hdr,之后对nalu_hdr的写入就将写入sendbuf中。 nalu_hdr->F=pNalu->forbidden_bit; nalu_hdr->NRI=pNalu->nal_reference_idc>>5;//有效数据在n->nal_reference_idc的第6。7位,须要右移5位才干将其值赋给nalu_hdr->NRI。 nalu_hdr->TYPE=pNalu->nal_unit_type; nalu_payload=&sendbuf[13];//同理将sendbuf[13]赋给nalu_payload memcpy(nalu_payload,pNalu->buf+1,pNalu->len-1);//去掉nalu头的nalu剩余内容写入sendbuf[13]開始的字符串。 ts_current=ts_current+timestamp_increse; rtp_hdr->timestamp=htonl(ts_current); bytes=pNalu->len + 12 ; //获得sendbuf的长度,为nalu的长度(包括NALU头但除去起始前缀)加上rtp_header的固定长度12字节 send(socket1, sendbuf, bytes, 0 ); //发送rtp包 // Sleep(100); } else { //得到该nalu须要用多少长度为1400字节的RTP包来发送 int k=0, l=0; k=pNalu->len/1400; //须要k个1400字节的RTP包 l=pNalu->len%1400; //最后一个RTP包的须要装载的字节数 int t=0;//用于指示当前发送的是第几个分片RTP包 ts_current=ts_current+timestamp_increse; rtp_hdr->timestamp=htonl(ts_current); while(t<=k) { rtp_hdr->seq_no = htons(seq_num ++); //序列号,每发送一个RTP包增1 if(!t) //发送一个须要分片的NALU的第一个分片,置FU HEADER的S位 { //设置rtp M 位; rtp_hdr->marker=0; //设置FU INDICATOR,并将这个HEADER填入sendbuf[12] fu_ind =(FU_INDICATOR*)&sendbuf[12]; //将sendbuf[12]的地址赋给fu_ind,之后对fu_ind的写入就将写入sendbuf中; fu_ind->F=pNalu->forbidden_bit; fu_ind->NRI=pNalu->nal_reference_idc>>5; fu_ind->TYPE=28; //设置FU HEADER,并将这个HEADER填入sendbuf[13] fu_hdr =(FU_HEADER*)&sendbuf[13]; fu_hdr->E=0; fu_hdr->R=0; fu_hdr->S=1; fu_hdr->TYPE=pNalu->nal_unit_type; nalu_payload=&sendbuf[14];//同理将sendbuf[14]赋给nalu_payload memcpy(nalu_payload,pNalu->buf+1,1400);//去掉NALU头 bytes=1400+14; //获得sendbuf的长度,为nalu的长度(除去起始前缀和NALU头)加上rtp_header,fu_ind,fu_hdr的固定长度14字节 send(socket1, sendbuf, bytes, 0 );//发送rtp包 t++; } else { if(k==t) { // 发送最后一个零头,清零FU HEADER的S位,置FU HEADER的E位.注意最后一个分片的长度 // 可能超过1400字节(当l>1386时)。 // 设置rtp M 位;当前传输的是最后一个分片时该位置1 rtp_hdr->marker=1; //设置FU INDICATOR,并将这个HEADER填入sendbuf[12] fu_ind =(FU_INDICATOR*)&sendbuf[12]; //将sendbuf[12]的地址赋给fu_ind,之后对fu_ind的写入就将写入sendbuf中; fu_ind->F=pNalu->forbidden_bit; fu_ind->NRI=pNalu->nal_reference_idc>>5; fu_ind->TYPE=28; //设置FU HEADER,并将这个HEADER填入sendbuf[13] fu_hdr =(FU_HEADER*)&sendbuf[13]; fu_hdr->R=0; fu_hdr->S=0; fu_hdr->TYPE=pNalu->nal_unit_type; fu_hdr->E=1; nalu_payload=&sendbuf[14];//同理将sendbuf[14]的地址赋给nalu_payload memcpy(nalu_payload,pNalu->buf+t*1400+1,l-1);//将nalu最后剩余的l-1(去掉了一个字节的NALU头)字节内容写入sendbuf[14]開始的字符串。 bytes=l-1+14; //获得sendbuf的长度,为剩余nalu的长度l-1加上rtp_header,FU_INDICATOR,FU_HEADER三个包头共14字节 send(socket1, sendbuf, bytes, 0 );//发送rtp包 t++; // Sleep(100); }else { if(t<k) { // 发送其它整块(1400) //设置rtp M 位; rtp_hdr->marker=0; //设置FU INDICATOR,并将这个HEADER填入sendbuf[12] fu_ind =(FU_INDICATOR*)&sendbuf[12]; //将sendbuf[12]的地址赋给fu_ind。之后对fu_ind的写入就将写入sendbuf中; fu_ind->F=pNalu->forbidden_bit; fu_ind->NRI=pNalu->nal_reference_idc>>5; fu_ind->TYPE=28; //设置FU HEADER,并将这个HEADER填入sendbuf[13] fu_hdr =(FU_HEADER*)&sendbuf[13]; //fu_hdr->E=0; fu_hdr->R=0; fu_hdr->S=0; fu_hdr->E=0; fu_hdr->TYPE=pNalu->nal_unit_type; nalu_payload=&sendbuf[14];//同理将sendbuf[14]的地址赋给nalu_payload memcpy(nalu_payload,pNalu->buf+t*1400+1,1400);//去掉起始前缀的nalu剩余内容写入sendbuf[14]開始的字符串。 bytes=1400+14; //获得sendbuf的长度,为nalu的长度(除去原NALU头)加上rtp_header。fu_ind,fu_hdr的固定长度14字节 send( socket1, sendbuf, bytes, 0 );//发送rtp包 t++; } } } } } } FreeNALU(pNalu); return 0; } //——————————————– //以下为音频 memset(sendbuf,0,MAX_RTP_PKT_LENGTH );//清空sendbuf。此时会将上次的时间戳清空,因此须要ts_current来保存上次的时间戳值 //rtp固定包头。为12字节,该句将sendbuf[0]的地址赋给rtp_hdr,以后对rtp_hdr的写入操作将直接写入sendbuf。 rtp_hdr =(RTP_FIXED_HEADER*)&sendbuf[0]; rtp_hdr->payload = AAC; //负载类型号, rtp_hdr->version = 2; //版本号号,此版本号固定为2 rtp_hdr->marker = 1; //标志位,由详细协议规定其值。 rtp_hdr->ssrc = htonl(10); //随机指定为10,而且在本RTP会话中全局唯一 rtp_hdr->seq_no = htons(seq_num ++); //序列号。每发送一个RTP包增1 rc = mp4ff_read_sample(infile,track,sampleId,&buffer,(unsigned int *)&buffer_size);//FAAD里自带的 MP4FF读取 Sample memset(buff,0,MAX_RTP_PKT_LENGTH);//清空sample buff memcpy(buff,buffer,buffer_size);、、把取到的buffer 放入 buff中 latm_hdr = (LATM_HEADER*)&sendbuf[12]; latm_hdr->p0 = 0x00; latm_hdr->p1 = 0x10; latm_hdr->p2 = (rc & 0x1fe0) >> 5; latm_hdr->p3 = (rc & 0x1f) << 3; ts_current=ts_current+timestamp_increse; rtp_hdr->timestamp=htonl(ts_current); memcpy(&sendbuf[16],buff,len); send( socket1, sendbuf, rc+16, 0 );//发送rtp包 printf(“samplesId:%d rc:%d ts:%ld\n”,sampleId,rc,rtp_hdr->timestamp); 上述RTP_FIXED_HEADER结构 // 定义RTP固定头结构 typedef struct { /* byte 0 */ unsigned char csrc_len:4; /* CSRC 计数4位 */ unsigned char extension:1; /* 扩展1位 */ unsigned char padding:1; /* 填充1位 */ unsigned char version:2; /* 版本号2位 */ /* byte 1 */ unsigned char payload:7; /* 负载类型 */ unsigned char marker:1; /* 标志1位 */ /* bytes 2, 3 */ unsigned short seq_no; /* bytes 4-7 */ unsigned long timestamp; /* bytes 8-11 */ unsigned long ssrc; /* 事实上,它是一个随机生成ID,他表示RTP联系。在申请时。确保ID唯一的就可以了。 */ } RTP_FIXED_HEADER; |