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

╰+哭是因爲堅強的太久メ 2024-02-20 10:43 51阅读 0赞

最近做国标级联，鼓捣了个简单的ps流封装，做分享做笔记。

#include <stdint.h>
    #include <string>
    #include <memory.h>
     
    #define H264_ID        0x1b
    #define H265_ID        0x24
    #define MPEG_ID        0x10
    #define SVACV_ID       0x80
     
    #define G711_ID        0x90
    #define SVACA_ID       0x9b
     
    const uint8_t PS_HEAD[] = {
        /*PS头*/
        0x00, 0x00, 0x01, 0xba,
        0x00, 0x00, 0x00, 0x00, 0x00, 0x00,        /*时间戳*/
        0x01, 0x47, 0xb3, 
        0xf8
    };
     
    const uint8_t SYS_MAP_HEAD[] = {
        /*PS_SYS头*/
        0x00, 0x00, 0x01, 0xbb, 
        0x00, 0x0c,                                /*sys头长度,不含自己，6+3*流的数目*/
        0x80, 0xa3, 0xd9,                          /*速率*/
        0x04, 0xe1,                                /*音频流数，视频流数加3个1标识*/
        0xff,                                      /**/
        0xb9, 0xe0, 0x00, 0xb8, 0xc0, 0x40,        /*流信息，b9视频，b8音频*/
        /*PS_MAP头*/
        0x00, 0x00, 0x01, 0xbc, 
        0x00, 0x12,                                /*psm长度*/
        0xe1, 0xff,                                /**/
        0x00, 0x00, 0x00, 0x08,                    /*固定2路流*/
        0x1b, 0xe0, 0x00, 0x00,                    /*视频，第一个字节(0x1b), 跟具不同的视频编码改变即可封装不同的流，见开头宏定义*/
        0x90, 0xc0, 0x00, 0x00,                    /*音频，同视频*/
        0x00, 0x00, 0x00, 0x00                     /*4b CRC，暂时没设置*/
    };
     
    const uint8_t PES_HEAD[] = {
        /*PS_PES头*/
        0x00, 0x00, 0x01, 0xe0, 
        0x00, 0x00,                                /*pes长度*/
        0x80, 0xc0,                                /*附加信息*/
        0x0a,                                      /*附加信息长度*/
        0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00  /*pts和pds*/
    };
     
    void SetHeaderTimeStamp(uint8_t *dest, uint64_t pts)
    {
        uint8_t *scr_buf = dest + 4;
        scr_buf[0] = 0x40 | (((uint8_t)(pts >> 30) & 0x07) << 3) | 0x04 | ((uint8_t)(pts >> 28) & 0x03);
        scr_buf[1] = (uint8_t)((pts >> 20) & 0xff);
        scr_buf[2] = (((uint8_t)(pts >> 15) & 0x1f) << 3) | 0x04 | ((uint8_t)(pts >> 13) & 0x03);
        scr_buf[3] = (uint8_t)((pts >> 5) & 0xff);
        scr_buf[4] = (((uint8_t)pts & 0x1f) << 3) | 0x04;
        scr_buf[5] = 1;
    }
     
    // 设置PES头中的PTS和DTS字段
    void SetPESTimeStamp(uint8_t *buff, uint64_t ts)
    {
        buff += 9;
        // PTS
        buff[0] = (uint8_t)(((ts >> 30) & 0x07) << 1) | 0x30 | 0x01;
        buff[1] = (uint8_t)((ts >> 22) & 0xff);
        buff[2] = (uint8_t)(((ts >> 15) & 0xff) << 1) | 0x01;
        buff[3] = (uint8_t)((ts >> 7) & 0xff);
        buff[4] = (uint8_t)((ts & 0xff) << 1) | 0x01;
        // DTS
        buff[5] = (uint8_t)(((ts >> 30) & 0x07) << 1) | 0x10 | 0x01;
        buff[6] = (uint8_t)((ts >> 22) & 0xff);
        buff[7] = (uint8_t)(((ts >> 15) & 0xff) << 1) | 0x01;
        buff[8] = (uint8_t)((ts >> 7) & 0xff);
        buff[9] = (uint8_t)((ts & 0xff) << 1) | 0x01;
    }
     
    int GetSinglePESHeader(uint8_t *header, uint64_t mtime, uint16_t farmLen)
    {
        farmLen += 13;
        memcpy(header, PES_HEAD, sizeof(PES_HEAD));
        *(header+4) = (uint8_t)(farmLen>>8);
        *(header+5) = (uint8_t)farmLen;
     
        SetPESTimeStamp(header, mtime);
        return sizeof(PES_HEAD);
    }
     
    int GetPSHeader(uint8_t *header, uint64_t mtime, uint16_t farmLen, int streamType, int farmType)
    {
        if(streamType == 2)        //语音包
        {
            GetSinglePESHeader(header, mtime, farmLen);
            *(header+3) = 0xc0;
            return sizeof(PES_HEAD);
        }
        else if(farmType == 1)    //I帧
        {
            memcpy(header, PS_HEAD, sizeof(PS_HEAD));
            SetHeaderTimeStamp(header, mtime);
            header += sizeof(PS_HEAD);
     
            memcpy(header, SYS_MAP_HEAD, sizeof(SYS_MAP_HEAD));
            header += sizeof(SYS_MAP_HEAD);
     
            GetSinglePESHeader(header, mtime, farmLen);
            return sizeof(PS_HEAD) + sizeof(SYS_MAP_HEAD) + sizeof(PES_HEAD);
        }
        else
        {
            memcpy(header, PS_HEAD, sizeof(PS_HEAD));
            SetHeaderTimeStamp(header, mtime);
            header += sizeof(PS_HEAD);
     
            GetSinglePESHeader(header, mtime, farmLen);
            return sizeof(PS_HEAD) + sizeof(PES_HEAD);
        }
    }
     
    unsigned char PSFrameBuffer[10*1024*1024]; //转换后的ps帧缓存区
    int TransPSFrame(char *pFrame, int nFrameLength, int nIFrameFlag, int nStreamType, u_int nTimeStamp)
    {
        if(!pFrame || !nFrameLength)
            return 0;
     
        // 每个pes最多65400数据
        int PesLenth = nFrameLength > 65400 ? 65400 : nFrameLength;    
        // 第一个pes需要有ps头，其它不需要，音频直接打包pes（00 00 01 c0)
        int psHeadLen = GetPSHeader(PSFrameBuffer, nTimeStamp, PesLenth, nStreamType, nIFrameFlag);
        memcpy(PSFrameBuffer + psHeadLen, pFrame, PesLenth);
        int psSize = psHeadLen + PesLenth;
        int pod = PesLenth;
     
        nFrameLength -= PesLenth;
        while (nFrameLength > 0)
        {
            PesLenth = nFrameLength > 65400 ? 65400 : nFrameLength;
            psHeadLen = GetSinglePESHeader(PSFrameBuffer + psSize, nTimeStamp, PesLenth);
     
            memcpy(PSFrameBuffer + psSize + psHeadLen, pFrame + pod, PesLenth);
            psSize += (PesLenth + psHeadLen);    
            pod += PesLenth;
            nFrameLength -= PesLenth;
        }
     
        //static FILE *fp = fopen("my.ps", "wb");
        //if(fp)
        //    fwrite(PSFrameBuffer, 1, psSize, fp);
     
        return psSize;
    }

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\]的值）:

PSMUX\_ST\_RESERVED = 0x00,  
PSMUX\_ST\_VIDEO\_MPEG1 = 0x01,  
PSMUX\_ST\_VIDEO\_MPEG2 = 0x02,  
PSMUX\_ST\_AUDIO\_MPEG1 = 0x03,  
PSMUX\_ST\_AUDIO\_MPEG2 = 0x04,  
PSMUX\_ST\_PRIVATE\_SECTIONS = 0x05,  
PSMUX\_ST\_PRIVATE\_DATA = 0x06,  
PSMUX\_ST\_MHEG = 0x07,  
PSMUX\_ST\_DSMCC = 0x08,  
PSMUX\_ST\_H222\_1 = 0x09,  
PSMUX\_ST\_AUDIO\_AAC = 0x0f,  
PSMUX\_ST\_VIDEO\_MPEG4 = 0x10,  
PSMUX\_ST\_VIDEO\_H264 = 0x1b,  
PSMUX\_ST\_VIDEO\_H265 = 0x24,  
PSMUX\_ST\_PS\_VIDEO\_SVAC = 0x80,  
PSMUX\_ST\_PS\_AUDIO\_AC3 = 0x81,  
PSMUX\_ST\_PS\_AUDIO\_DTS = 0x8a,  
PSMUX\_ST\_PS\_AUDIO\_LPCM = 0x8b,  
PSMUX\_ST\_PS\_AUDIO\_G711A = 0x90,  
PSMUX\_ST\_PS\_AUDIO\_G711U = 0x91,  
PSMUX\_ST\_PS\_AUDIO\_G722\_1 = 0x92,  
PSMUX\_ST\_PS\_AUDIO\_G723\_1 = 0x93,  
PSMUX\_ST\_PS\_AUDIO\_G729 = 0x99,  
PSMUX\_ST\_PS\_AUDIO\_SVAC = 0x9b,  
PSMUX\_ST\_PS\_DVD\_SUBPICTURE = 0xff,  
//下面定义不是标准里面定义的  
PSMUX\_ST\_VIDEO\_DIRAC = 0xD1  
鉴于有人评论要示例程序，简单写了下h264打包，CSDN资源下载

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

#include "stdafx.h"
    #include <stdlib.h>
    #include "ps.hpp"
     
    int ReadSourceStream(char **frame_data, int *frame_size)
    {
    	static FILE *fp = NULL; 
    	if (fp == NULL)
    	{
    		fp = fopen("es_stream.h264", "rb");
    		if (fp == NULL)
    		{
    			printf("open file es_stream.h264 error\n");
    			return -1;
    		}
    	}
     
    	//文件格式为：
    	//     1    2    3    4         n
    	//|----|----|----|----|---------
    	//|       帧长度       |   数据   
    	do {
    		if (4 != fread(frame_size, 1, 4, fp))
    			break;
    		*frame_data = (char*)malloc(*frame_size);
    		if (*frame_size != fread(*frame_data, 1, *frame_size, fp))
    			break;
    		return 0;
    	} while (0);
    	printf("read file es_stream.h264 eof\n");
    	fclose(fp);
    	fp = NULL;
    	return -2;
    }
     
    int KeyFrame(uint8_t nalu)
    {
    	int nalType = nalu & 0x1f;
    	if (nalType == 0x07 || nalType == 0x05 || nalType == 0x08) 
    		return 1;
    	return 0;
    }
     
    int main()
    {
    	char *frame_data;
    	int frame_size, ps_size;
    	uint32_t ts = 0;
     
    	FILE *fp = fopen("my_h264.ps", "wb");
    	while (0 == ReadSourceStream(&frame_data, &frame_size))
    	{
    		// 文件中只有h264视频，第4个参数固定填1，音频为2
    		ps_size = TransPSFrame(frame_data, frame_size, KeyFrame((uint8_t)frame_data[4]), 1, ts);
    		fwrite(PSFrameBuffer, 1, ps_size, fp);
    		ts += 3600;
    		free(frame_data);
    	}
    	fclose(fp);
    	getchar();
        return 0;
    }

es\_stream.h264文件在下载链接的工程中，文件格式是 4字节帧长度（小端）+ 帧数据