参考链接: 1. MPEG-2 TS码流分析 https://blog.csdn.net/zhubin215130/article/details/8958567
TS Header
PAT
PMT

1 #include <stdio.h> 2 #include <stdlib.h> 3 #include <string.h> 4 #include <arpa/inet.h> 5 6 #define TAB44 " " 7 #define TAB46 " " 8 #define PRINTF_DEBUG 9 10 #define TS_PAT_PID 0x0 11 12 #define TS_PAT_TABLE_PID 0x0 13 #define TS_PMT_TABLE_PID 0x2 14 15 #define MAX_PDTS_LEN 5 16 #define MAX_TS_PROGRAM_NUM 8 17 #define MAX_TS_STREAM_NUM 8 18 #define MAX_PDTS_STRING_LEN 12 19 #define MAX_TS_PACKET_LEN 188 /* 204, 188+16字节的CRC */ 20 21 22 /****************************************************************** 23 视频 24 MPEG-1 Video:stream_type为0x01 25 MPEG-2 Video:stream_type为0x02 26 AVC(H264):stream_type为0x1b 27 VC-1:stream_type为0xea 28 29 音频 30 Mpeg-1 Audio:stream_type为0x03 31 Mpeg-2 Audio:stream_type为0x04 32 Mpeg-2 AAC:stream_type为0x0f 33 Mpeg-4 AAC:stream_type为0x11 34 LPCM:stream_type为0x80 35 AC3:stream_type为0x81或0x06 36 DTS:stream_type为0x82 37 Dolby TrueHD:stream_type为0x83 38 AC3-Plus:stream_type为0x84 39 DTS_HD:stream_type为0x85 40 DTS-MA:stream_type为0x86 41 AC3-Plus_SEC:steam_type为0xa1 42 DTS_HD_SEC:stream_type为0xa2 43 44 字幕 45 PGS:stream_type为0x90 46 IGS:steam_type为0x91,暂不支持 47 Text Subtitle:stream_type为0x92 48 ********************************************************************/ 49 typedef enum t_ts_stream_type 50 { 51 E_STREAM_TYPE_MPEG1_VIDEO = 0x01, 52 E_STREAM_TYPE_MPEG2_VIDEO = 0x02, 53 E_STREAM_TYPE_AVC_VIDEO = 0x1B, 54 E_STREAM_TYPE_VC1_VIDEO = 0xEA, 55 E_STREAM_TYPE_MPEG1_AUDIO = 0x03, 56 E_STREAM_TYPE_MPEG2_AUDIO = 0x04, 57 E_STREAM_TYPE_MPEG2_AAC = 0x0F, 58 E_STREAM_TYPE_MPEG4_AAC = 0x11, 59 E_STREAM_TYPE_AC3 = 0x81, 60 } T_TS_STREAM_TYPE; 61 62 /* 4 bytes */ 63 typedef struct t_ts_packet_header 64 { 65 unsigned char sync_byte; 66 unsigned short transport_error_indictor:1, playload_unit_start_indictor:1, transport_priority:1, pid:13; 67 unsigned char transport_scrambling_control:2, adaptation_field_control:2, continuity_counter:4; 68 } T_TS_PACKET_HEADER; 69 70 /* PAT */ 71 typedef struct t_ts_program 72 { 73 unsigned short program_number; 74 unsigned short program_map_pid; 75 } T_TS_PROGRAM; 76 77 typedef struct t_ts_pat 78 { 79 unsigned char table_id; 80 unsigned short section_len; 81 unsigned char version_num:5; 82 unsigned short programNum; 83 84 T_TS_PROGRAM programs[MAX_TS_PROGRAM_NUM]; 85 } T_TS_PAT; 86 87 /* PMT */ 88 typedef struct t_ts_stream 89 { 90 unsigned char stream_type; 91 unsigned short elementary_pid; 92 } T_TS_STREAM; 93 94 typedef struct t_ts_pmt 95 { 96 unsigned short pmtIsFind; 97 unsigned char table_id; 98 unsigned short section_len; 99 unsigned short program_number; 100 unsigned char version_num:5; 101 unsigned short program_info_length; 102 103 unsigned short streamNum; 104 105 T_TS_STREAM streams[MAX_TS_STREAM_NUM]; 106 } T_TS_PMT; 107 108 /* PES */ 109 typedef struct t_ts_pes 110 { 111 unsigned char streamId; 112 113 unsigned short pesLength; 114 115 long long pts; 116 long long dts; 117 118 unsigned char ptsStr[MAX_PDTS_STRING_LEN+1]; 119 unsigned char dtsStr[MAX_PDTS_STRING_LEN+1]; 120 121 unsigned char pesHeaderLen; 122 } T_TS_PES; 123 124 T_TS_PAT g_TsPat = {0}; 125 T_TS_PMT g_TsPmt[MAX_TS_PROGRAM_NUM] = {0}; 126 127 static void ParseTsHeader(unsigned char* const headerData, T_TS_PACKET_HEADER *tsPacketHeader) 128 { 129 static int tsPacketNum = 0; 130 131 int offset = 0; 132 133 unsigned char *data = NULL; 134 135 T_TS_PACKET_HEADER tsHeader = {0}; 136 137 memset(&tsHeader, 0x0, sizeof(tsHeader)); 138 139 data = headerData; 140 141 tsHeader.sync_byte = data[0]; 142 tsHeader.transport_error_indictor = ((data[1]>>7)&0x1); 143 tsHeader.playload_unit_start_indictor = ((data[1]>>6)&0x1); 144 tsHeader.transport_priority = ((data[1]>>5)&0x1); 145 tsHeader.pid = (((data[1]&0x1f)<<8) | data[2]); 146 tsHeader.transport_scrambling_control = ((data[3]>>6)&0x3); 147 tsHeader.adaptation_field_control = ((data[3]>>4)&0x3); 148 tsHeader.continuity_counter = data[3]&0xf; 149 150 memcpy(tsPacketHeader, &tsHeader, sizeof(tsHeader)); 151 152 #ifdef PRINTF_DEBUG 153 offset = tsPacketNum*MAX_TS_PACKET_LEN; 154 155 switch (tsHeader.adaptation_field_control) 156 { 157 case 1: 158 if (tsHeader.playload_unit_start_indictor) 159 { 160 printf("0x%08x Transport Packet{PID = 0x%x, Payload = YES(%d), Counter = %d, Start indicactor} ", 161 offset, tsHeader.pid, MAX_TS_PACKET_LEN-4, tsHeader.continuity_counter); 162 } 163 else 164 { 165 printf("0x%08x Transport Packet{PID = 0x%x, Payload = YES(%d), Counter = %d} ", 166 offset, tsHeader.pid, MAX_TS_PACKET_LEN-4, tsHeader.continuity_counter); 167 } 168 169 break; 170 171 case 2: 172 if (tsHeader.playload_unit_start_indictor) 173 { 174 printf("0x%08x Transport Packet{PID = 0x%x, Payload = NO, Counter = %d, Start indicactor} ", 175 offset, tsHeader.pid, tsHeader.continuity_counter); 176 } 177 else 178 { 179 printf("0x%08x Transport Packet{PID = 0x%x, Payload = NO, Counter = %d} ", 180 offset, tsHeader.pid, tsHeader.continuity_counter); 181 } 182 183 break; 184 185 case 3: 186 if (tsHeader.playload_unit_start_indictor) 187 { 188 printf("0x%08x Transport Packet{PID = 0x%x, Payload = YES(%d), Counter = %d, Start indicactor} ", 189 offset, tsHeader.pid, MAX_TS_PACKET_LEN-4-1-data[4], tsHeader.continuity_counter); 190 } 191 else 192 { 193 printf("0x%08x Transport Packet{PID = 0x%x, Payload = YES(%d), Counter = %d} ", 194 offset, tsHeader.pid, MAX_TS_PACKET_LEN-4-1-data[4], tsHeader.continuity_counter); 195 } 196 197 break; 198 199 default: 200 break; 201 202 } 203 204 tsPacketNum++; 205 #endif 206 } 207 208 static void ParseTsPat(unsigned char* const patData, T_TS_PAT *tsPat) 209 { 210 int i = 0; 211 int sectionLen = 0; 212 213 unsigned char *data = NULL; 214 215 T_TS_PAT pat = {0}; 216 217 memset(&pat, 0x0, sizeof(pat)); 218 219 data = patData; 220 221 pat.table_id = data[0]; 222 223 if (TS_PAT_TABLE_PID != pat.table_id) 224 { 225 return; 226 } 227 228 sectionLen = ((data[1]&0xf)<<8) | data[2]; 229 pat.section_len = sectionLen; 230 231 pat.version_num = ((data[5]>>1) & 0x1f); 232 233 data += 8; 234 sectionLen -= (5+4); /* len is after section_len and not have crc */ 235 236 while (sectionLen>0) 237 { 238 if (i >= MAX_TS_PROGRAM_NUM) 239 { 240 break; 241 } 242 243 pat.programs[i].program_number = ((data[0]<<8) | data[1]); 244 245 if (0 != pat.programs[i].program_number) 246 { 247 pat.programs[i].program_map_pid = (((data[2]&0x1f)<<8) | data[3]); 248 } 249 250 data += 4; 251 sectionLen -= 4; 252 253 i++; 254 255 pat.programNum = i; 256 } 257 258 memcpy(tsPat, &pat, sizeof(pat)); 259 260 #ifdef PRINTF_DEBUG 261 printf("%s%s Program Association Table, version: %d ", TAB46, TAB44, pat.version_num); 262 263 for (i=0; i<pat.programNum; i++) 264 { 265 printf("%s%s%s program_number: %d, program_map_PID: 0x%x ", TAB46, TAB44, TAB44, pat.programs[i].program_number, pat.programs[i].program_map_pid); 266 } 267 #endif 268 } 269 270 static void ParseTsPmt(unsigned char* const pmtData, T_TS_PMT *tsPmt) 271 { 272 int i = 0; 273 int sectionLen = 0; 274 int program_info_length = 0; 275 int es_info_length = 0; 276 277 unsigned char *data = NULL; 278 279 T_TS_PMT pmt = {0}; 280 281 memset(&pmt, 0x0, sizeof(pmt)); 282 283 data = pmtData; 284 285 pmt.table_id = data[0]; 286 287 if (TS_PMT_TABLE_PID != pmt.table_id) 288 { 289 return; 290 } 291 292 sectionLen = ((data[1]&0xf)<<8) | data[2]; 293 pmt.section_len = sectionLen; 294 295 pmt.program_number = data[3]<<8 | data[4]; 296 297 pmt.version_num = ((data[5]>>1) & 0x1f); 298 299 data += 10; 300 sectionLen -= (7+4); 301 302 program_info_length = ((data[0]&0xf)<<8) | data[1]; 303 304 data += 2; 305 sectionLen -= 2; 306 307 data += program_info_length; 308 sectionLen -= program_info_length; 309 310 while (sectionLen > 0) 311 { 312 if (i >= MAX_TS_STREAM_NUM) 313 { 314 break; 315 } 316 317 pmt.streams[i].stream_type = data[0]; 318 pmt.streams[i].elementary_pid = (((data[1]&0x1f)<<8) | data[2]); 319 320 es_info_length = ((data[3]&0xf)<<8) | data[4]; 321 322 data += 5; 323 sectionLen -= 5; 324 325 data += es_info_length; 326 sectionLen -= es_info_length; 327 328 i++; 329 330 pmt.streamNum = i; 331 } 332 333 pmt.pmtIsFind = 1; 334 335 memcpy(tsPmt, &pmt, sizeof(pmt)); 336 337 #ifdef PRINTF_DEBUG 338 printf("%s%s Program Map Table, version: %d ", TAB46, TAB44, pmt.version_num); 339 340 for (i=0; i<pmt.streamNum; i++) 341 { 342 printf("%s%s%s stream_type: 0x%x(%d), elementary_pid: 0x%x(%d) ", TAB46, TAB44, TAB44, pmt.streams[i].stream_type, pmt.streams[i].stream_type, 343 pmt.streams[i].elementary_pid, pmt.streams[i].elementary_pid); 344 } 345 #endif 346 } 347 348 static void getPdts(unsigned char *pdtsData, long long *pdts, unsigned char *pdtsString) 349 { 350 int hour = 0; 351 int minute = 0; 352 int second = 0; 353 int msecond = 0; 354 355 long long pts = 0; 356 long long pts2Ms = 0; 357 358 unsigned char ptsStr[MAX_PDTS_STRING_LEN+1] = {0}; 359 360 /* 5个字节转33位的值 */ 361 pts = (((pdtsData[0]>>1) & 0x7) << 30) | (pdtsData[1] << 22) | (((pdtsData[2]>>1) & 0x7f) << 15) | (pdtsData[3] << 7) | (pdtsData[4]>>1 & 0x7f); 362 363 /* 90KHz, 1000ms/90 */ 364 pts2Ms = pts/90; 365 366 hour = pts2Ms/(60*60*1000); 367 minute = (pts2Ms - hour * (60*60*1000)) / (60*1000); 368 second = (pts2Ms - hour * (60*60*1000) - minute * (60*1000)) / 1000; 369 msecond = pts2Ms - hour * (60*60*1000) - minute * (60*1000) - second * 1000; 370 371 sprintf(ptsStr, "%02d:%02d:%02d:%03d", hour, minute, second, msecond); 372 373 ptsStr[MAX_PDTS_STRING_LEN] = '