h264、h265、svac封装成ps流符合gb28181过检码流要求

admin

简单的ps流封装，做分享笔记：

1. #include <stdint.h>
   
2. #include <string>
   
3. #include <memory.h>
   
4. 
   
5. #define H264_ID        0x1b
   
6. #define H265_ID        0x24
   
7. #define MPEG_ID        0x10
   
8. #define SVACV_ID       0x80
   
9. 
   
10. #define G711_ID        0x90
    
11. #define SVACA_ID       0x9b
    
12. 
    
13. const uint8_t PS_HEAD[] = {
    
14.     /*PS头*/
    
15.     0x00, 0x00, 0x01, 0xba,
    
16.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00,        /*时间戳*/
    
17.     0x01, 0x47, 0xb3,
    
18.     0xf8
    
19. };
    
20. 
    
21. const uint8_t SYS_MAP_HEAD[] = {
    
22.     /*PS_SYS头*/
    
23.     0x00, 0x00, 0x01, 0xbb,
    
24.     0x00, 0x0c,                                /*sys头长度,不含自己，6+3*流的数目*/
    
25.     0x80, 0xa3, 0xd9,                          /*速率*/
    
26.     0x04, 0xe1,                                /*音频流数，视频流数加3个1标识*/
    
27.     0xff,                                      /**/
    
28.     0xb9, 0xe0, 0x00, 0xb8, 0xc0, 0x40,        /*流信息，b9视频，b8音频*/
    
29.     /*PS_MAP头*/
    
30.     0x00, 0x00, 0x01, 0xbc,
    
31.     0x00, 0x12,                                /*psm长度*/
    
32.     0xe1, 0xff,                                /**/
    
33.     0x00, 0x00, 0x00, 0x08,                    /*固定2路流*/
    
34.     0x1b, 0xe0, 0x00, 0x00,                    /*视频，第一个字节(0x1b), 跟具不同的视频编码改变即可封装不同的流，见开头宏定义*/
    
35.     0x90, 0xc0, 0x00, 0x00,                    /*音频，同视频*/
    
36.     0x00, 0x00, 0x00, 0x00                     /*4b CRC，暂时没设置*/
    
37. };
    
38. 
    
39. const uint8_t PES_HEAD[] = {
    
40.     /*PS_PES头*/
    
41.     0x00, 0x00, 0x01, 0xe0,
    
42.     0x00, 0x00,                                /*pes长度*/
    
43.     0x80, 0xc0,                                /*附加信息*/
    
44.     0x0a,                                      /*附加信息长度*/
    
45.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00  /*pts和pds*/
    
46. };
    
47. 
    
48. void SetHeaderTimeStamp(uint8_t *dest, uint64_t pts)
    
49. {
    
50.     uint8_t *scr_buf = dest + 4;
    
51.     scr_buf[0] = 0x40 | (((uint8_t)(pts >> 30) & 0x07) << 3) | 0x04 | ((uint8_t)(pts >> 28) & 0x03);
    
52.     scr_buf[1] = (uint8_t)((pts >> 20) & 0xff);
    
53.     scr_buf[2] = (((uint8_t)(pts >> 15) & 0x1f) << 3) | 0x04 | ((uint8_t)(pts >> 13) & 0x03);
    
54.     scr_buf[3] = (uint8_t)((pts >> 5) & 0xff);
    
55.     scr_buf[4] = (((uint8_t)pts & 0x1f) << 3) | 0x04;
    
56.     scr_buf[5] = 1;
    
57. }
    
58. 
    
59. // 设置PES头中的PTS和DTS字段
    
60. void SetPESTimeStamp(uint8_t *buff, uint64_t ts)
    
61. {
    
62.     buff += 9;
    
63.     // PTS
    
64.     buff[0] = (uint8_t)(((ts >> 30) & 0x07) << 1) | 0x30 | 0x01;
    
65.     buff[1] = (uint8_t)((ts >> 22) & 0xff);
    
66.     buff[2] = (uint8_t)(((ts >> 15) & 0xff) << 1) | 0x01;
    
67.     buff[3] = (uint8_t)((ts >> 7) & 0xff);
    
68.     buff[4] = (uint8_t)((ts & 0xff) << 1) | 0x01;
    
69.     // DTS
    
70.     buff[5] = (uint8_t)(((ts >> 30) & 0x07) << 1) | 0x10 | 0x01;
    
71.     buff[6] = (uint8_t)((ts >> 22) & 0xff);
    
72.     buff[7] = (uint8_t)(((ts >> 15) & 0xff) << 1) | 0x01;
    
73.     buff[8] = (uint8_t)((ts >> 7) & 0xff);
    
74.     buff[9] = (uint8_t)((ts & 0xff) << 1) | 0x01;
    
75. }
    
76. 
    
77. int GetSinglePESHeader(uint8_t *header, uint64_t mtime, uint16_t farmLen)
    
78. {
    
79.     farmLen += 13;
    
80.     memcpy(header, PES_HEAD, sizeof(PES_HEAD));
    
81.     *(header+4) = (uint8_t)(farmLen>>8);
    
82.     *(header+5) = (uint8_t)farmLen;
    
83. 
    
84.     SetPESTimeStamp(header, mtime);
    
85.     return sizeof(PES_HEAD);
    
86. }
    
87. 
    
88. int GetPSHeader(uint8_t *header, uint64_t mtime, uint16_t farmLen, int streamType, int farmType)
    
89. {
    
90.     if(streamType == 2)        //语音包
    
91.     {
    
92.         GetSinglePESHeader(header, mtime, farmLen);
    
93.         *(header+3) = 0xc0;
    
94.         return sizeof(PES_HEAD);
    
95.     }
    
96.     else if(farmType == 1)    //I帧
    
97.     {
    
98.         memcpy(header, PS_HEAD, sizeof(PS_HEAD));
    
99.         SetHeaderTimeStamp(header, mtime);
    
100.         header += sizeof(PS_HEAD);
     
101. 
     
102.         memcpy(header, SYS_MAP_HEAD, sizeof(SYS_MAP_HEAD));
     
103.         header += sizeof(SYS_MAP_HEAD);
     
104. 
     
105.         GetSinglePESHeader(header, mtime, farmLen);
     
106.         return sizeof(PS_HEAD) + sizeof(SYS_MAP_HEAD) + sizeof(PES_HEAD);
     
107.     }
     
108.     else
     
109.     {
     
110.         memcpy(header, PS_HEAD, sizeof(PS_HEAD));
     
111.         SetHeaderTimeStamp(header, mtime);
     
112.         header += sizeof(PS_HEAD);
     
113. 
     
114.         GetSinglePESHeader(header, mtime, farmLen);
     
115.         return sizeof(PS_HEAD) + sizeof(PES_HEAD);
     
116.     }
     
117. }
     
118. 
     
119. unsigned char PSFrameBuffer[10*1024*1024]; //转换后的ps帧缓存区
     
120. int TransPSFrame(char *pFrame, int nFrameLength, int nIFrameFlag, int nStreamType, u_int nTimeStamp)
     
121. {
     
122.     if(!pFrame || !nFrameLength)
     
123.         return 0;
     
124. 
     
125.     // 每个pes最多65400数据
     
126.     int PesLenth = nFrameLength > 65400 ? 65400 : nFrameLength;   
     
127.     // 第一个pes需要有ps头，其它不需要，音频直接打包pes（00 00 01 c0)
     
128.     int psHeadLen = GetPSHeader(PSFrameBuffer, nTimeStamp, PesLenth, nStreamType, nIFrameFlag);
     
129.     memcpy(PSFrameBuffer + psHeadLen, pFrame, PesLenth);
     
130.     int psSize = psHeadLen + PesLenth;
     
131.     int pod = PesLenth;
     
132. 
     
133.     nFrameLength -= PesLenth;
     
134.     while (nFrameLength > 0)
     
135.     {
     
136.         PesLenth = nFrameLength > 65400 ? 65400 : nFrameLength;
     
137.         psHeadLen = GetSinglePESHeader(PSFrameBuffer + psSize, nTimeStamp, PesLenth);
     
138. 
     
139.         memcpy(PSFrameBuffer + psSize + psHeadLen, pFrame + pod, PesLenth);
     
140.         psSize += (PesLenth + psHeadLen);   
     
141.         pod += PesLenth;
     
142.         nFrameLength -= PesLenth;
     
143.     }
     
144. 
     
145.     //static FILE *fp = fopen("my.ps", "wb");
     
146.     //if(fp)
     
147.     //    fwrite(PSFrameBuffer, 1, psSize, fp);
     
148. 
     
149.     return psSize;
     
150. }

复制代码

（之前的固定字段中current_next_indicator 和vesion填了0和5导致打包出来的ps流vlc不能播放，已修复）

TransPSFrame函数为测试所用，应用时宜将得到的ps头部和帧数据直接写到rtp包中，省去memcpy过程。

SYS_MAP_HEAD中的数据是按国标ps流标准写死的，如果要封装格式数据需要修改。

封装h265和svac音频和svac视频时需要修改SYS_MAP_HEAD[30]和34，见注释和本文开头的宏定义

00 00 01 B9 为ps流结束标识符

附加各种编码对应的代码置（SYS_MAP_HEAD[30]和[34]的值）:

1.     PSMUX_ST_RESERVED                      = 0x00,
   
2.     PSMUX_ST_VIDEO_MPEG1                = 0x01,
   
3.     PSMUX_ST_VIDEO_MPEG2                = 0x02,
   
4.     PSMUX_ST_AUDIO_MPEG1                = 0x03,
   
5.     PSMUX_ST_AUDIO_MPEG2                = 0x04,
   
6.     PSMUX_ST_PRIVATE_SECTIONS      = 0x05,
   
7.     PSMUX_ST_PRIVATE_DATA                = 0x06,
   
8.     PSMUX_ST_MHEG                                 = 0x07,
   
9.     PSMUX_ST_DSMCC                              = 0x08,
   
10.     PSMUX_ST_H222_1                               = 0x09,
    
11.     PSMUX_ST_AUDIO_AAC                      = 0x0f,
    
12.     PSMUX_ST_VIDEO_MPEG4                = 0x10,
    
13.     PSMUX_ST_VIDEO_H264                     = 0x1b,
    
14.     PSMUX_ST_VIDEO_H265                     = 0x24,
    
15.     PSMUX_ST_PS_VIDEO_SVAC            = 0x80,
    
16.     PSMUX_ST_PS_AUDIO_AC3               = 0x81,
    
17.     PSMUX_ST_PS_AUDIO_DTS               = 0x8a,
    
18.     PSMUX_ST_PS_AUDIO_LPCM              = 0x8b,
    
19.     PSMUX_ST_PS_AUDIO_G711A             = 0x90,
    
20.     PSMUX_ST_PS_AUDIO_G711U             = 0x91,
    
21.     PSMUX_ST_PS_AUDIO_G722_1            = 0x92,
    
22.     PSMUX_ST_PS_AUDIO_G723_1            = 0x93,
    
23.     PSMUX_ST_PS_AUDIO_G729                = 0x99,
    
24.     PSMUX_ST_PS_AUDIO_SVAC               = 0x9b,
    
25.     PSMUX_ST_PS_DVD_SUBPICTURE     = 0xff,
    
26.     //下面定义不是标准里面定义的
    
27.     PSMUX_ST_VIDEO_DIRAC                      = 0xD1
    

复制代码

其实只需要将以上代码保持为一个ps.hpp文件，添加以下代码即可。

1. #include "stdafx.h"
   
2. #include <stdlib.h>
   
3. #include "ps.hpp"
   
4. 
   
5. int ReadSourceStream(char **frame_data, int *frame_size)
   
6. {
   
7.         static FILE *fp = NULL;
   
8.         if (fp == NULL)
   
9.         {
   
10.                 fp = fopen("es_stream.h264", "rb");
    
11.                 if (fp == NULL)
    
12.                 {
    
13.                         printf("open file es_stream.h264 error\n");
    
14.                         return -1;
    
15.                 }
    
16.         }
    
17. 
    
18.         //文件格式为：
    
19.         //     1    2    3    4         n
    
20.         //|----|----|----|----|---------
    
21.         //|       帧长度       |   数据   
    
22.         do {
    
23.                 if (4 != fread(frame_size, 1, 4, fp))
    
24.                         break;
    
25.                 *frame_data = (char*)malloc(*frame_size);
    
26.                 if (*frame_size != fread(*frame_data, 1, *frame_size, fp))
    
27.                         break;
    
28.                 return 0;
    
29.         } while (0);
    
30.         printf("read file es_stream.h264 eof\n");
    
31.         fclose(fp);
    
32.         fp = NULL;
    
33.         return -2;
    
34. }
    
35. 
    
36. int KeyFrame(uint8_t nalu)
    
37. {
    
38.         int nalType = nalu & 0x1f;
    
39.         if (nalType == 0x07 || nalType == 0x05 || nalType == 0x08)
    
40.                 return 1;
    
41.         return 0;
    
42. }
    
43. 
    
44. int main()
    
45. {
    
46.         char *frame_data;
    
47.         int frame_size, ps_size;
    
48.         uint32_t ts = 0;
    
49. 
    
50.         FILE *fp = fopen("my_h264.ps", "wb");
    
51.         while (0 == ReadSourceStream(&frame_data, &frame_size))
    
52.         {
    
53.                 // 文件中只有h264视频，第4个参数固定填1，音频为2
    
54.                 ps_size = TransPSFrame(frame_data, frame_size, KeyFrame((uint8_t)frame_data[4]), 1, ts);
    
55.                 fwrite(PSFrameBuffer, 1, ps_size, fp);
    
56.                 ts += 3600;
    
57.                 free(frame_data);
    
58.         }
    
59.         fclose(fp);
    
60.         getchar();
    
61.     return 0;
    
62. }
    

复制代码