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

#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
 

其实只需要将以上代码保持为一个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字节帧长度(小端)+ 帧数据

  • 0
    点赞
  • 1
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值