00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021 #include "avformat.h"
00022 #include "crc.h"
00023 #include "mpegts.h"
00024
00025
00026
00027
00028
00029
00030 typedef struct MpegTSSection {
00031 int pid;
00032 int cc;
00033 void (*write_packet)(struct MpegTSSection *s, const uint8_t *packet);
00034 void *opaque;
00035 } MpegTSSection;
00036
00037
00038 static void mpegts_write_section(MpegTSSection *s, uint8_t *buf, int len)
00039 {
00040 unsigned int crc;
00041 unsigned char packet[TS_PACKET_SIZE];
00042 const unsigned char *buf_ptr;
00043 unsigned char *q;
00044 int first, b, len1, left;
00045
00046 crc = bswap_32(av_crc(av_crc_get_table(AV_CRC_32_IEEE), -1, buf, len - 4));
00047 buf[len - 4] = (crc >> 24) & 0xff;
00048 buf[len - 3] = (crc >> 16) & 0xff;
00049 buf[len - 2] = (crc >> 8) & 0xff;
00050 buf[len - 1] = (crc) & 0xff;
00051
00052
00053 buf_ptr = buf;
00054 while (len > 0) {
00055 first = (buf == buf_ptr);
00056 q = packet;
00057 *q++ = 0x47;
00058 b = (s->pid >> 8);
00059 if (first)
00060 b |= 0x40;
00061 *q++ = b;
00062 *q++ = s->pid;
00063 s->cc = (s->cc + 1) & 0xf;
00064 *q++ = 0x10 | s->cc;
00065 if (first)
00066 *q++ = 0;
00067 len1 = TS_PACKET_SIZE - (q - packet);
00068 if (len1 > len)
00069 len1 = len;
00070 memcpy(q, buf_ptr, len1);
00071 q += len1;
00072
00073 left = TS_PACKET_SIZE - (q - packet);
00074 if (left > 0)
00075 memset(q, 0xff, left);
00076
00077 s->write_packet(s, packet);
00078
00079 buf_ptr += len1;
00080 len -= len1;
00081 }
00082 }
00083
00084 static inline void put16(uint8_t **q_ptr, int val)
00085 {
00086 uint8_t *q;
00087 q = *q_ptr;
00088 *q++ = val >> 8;
00089 *q++ = val;
00090 *q_ptr = q;
00091 }
00092
00093 static int mpegts_write_section1(MpegTSSection *s, int tid, int id,
00094 int version, int sec_num, int last_sec_num,
00095 uint8_t *buf, int len)
00096 {
00097 uint8_t section[1024], *q;
00098 unsigned int tot_len;
00099
00100 tot_len = 3 + 5 + len + 4;
00101
00102 if (tot_len > 1024)
00103 return -1;
00104
00105 q = section;
00106 *q++ = tid;
00107 put16(&q, 0xb000 | (len + 5 + 4));
00108 put16(&q, id);
00109 *q++ = 0xc1 | (version << 1);
00110 *q++ = sec_num;
00111 *q++ = last_sec_num;
00112 memcpy(q, buf, len);
00113
00114 mpegts_write_section(s, section, tot_len);
00115 return 0;
00116 }
00117
00118
00119
00120
00121 #define DEFAULT_PMT_START_PID 0x1000
00122 #define DEFAULT_START_PID 0x0100
00123 #define DEFAULT_PROVIDER_NAME "FFmpeg"
00124 #define DEFAULT_SERVICE_NAME "Service01"
00125
00126
00127 #define DEFAULT_ONID 0x0001
00128 #define DEFAULT_TSID 0x0001
00129 #define DEFAULT_SID 0x0001
00130
00131
00132 #define DEFAULT_PES_HEADER_FREQ 16
00133 #define DEFAULT_PES_PAYLOAD_SIZE ((DEFAULT_PES_HEADER_FREQ - 1) * 184 + 170)
00134
00135
00136 #define SDT_RETRANS_TIME 500
00137 #define PAT_RETRANS_TIME 100
00138 #define PCR_RETRANS_TIME 20
00139
00140 typedef struct MpegTSWriteStream {
00141 struct MpegTSService *service;
00142 int pid;
00143 int cc;
00144 int payload_index;
00145 int64_t payload_pts;
00146 int64_t payload_dts;
00147 uint8_t payload[DEFAULT_PES_PAYLOAD_SIZE];
00148 } MpegTSWriteStream;
00149
00150 typedef struct MpegTSService {
00151 MpegTSSection pmt;
00152 int sid;
00153 char *name;
00154 char *provider_name;
00155 int pcr_pid;
00156 int pcr_packet_count;
00157 int pcr_packet_freq;
00158 } MpegTSService;
00159
00160 typedef struct MpegTSWrite {
00161 MpegTSSection pat;
00162 MpegTSSection sdt;
00163 MpegTSService **services;
00164 int sdt_packet_count;
00165 int sdt_packet_freq;
00166 int pat_packet_count;
00167 int pat_packet_freq;
00168 int nb_services;
00169 int onid;
00170 int tsid;
00171 } MpegTSWrite;
00172
00173 static void mpegts_write_pat(AVFormatContext *s)
00174 {
00175 MpegTSWrite *ts = s->priv_data;
00176 MpegTSService *service;
00177 uint8_t data[1012], *q;
00178 int i;
00179
00180 q = data;
00181 for(i = 0; i < ts->nb_services; i++) {
00182 service = ts->services[i];
00183 put16(&q, service->sid);
00184 put16(&q, 0xe000 | service->pmt.pid);
00185 }
00186 mpegts_write_section1(&ts->pat, PAT_TID, ts->tsid, 0, 0, 0,
00187 data, q - data);
00188 }
00189
00190 static void mpegts_write_pmt(AVFormatContext *s, MpegTSService *service)
00191 {
00192
00193 uint8_t data[1012], *q, *desc_length_ptr, *program_info_length_ptr;
00194 int val, stream_type, i;
00195
00196 q = data;
00197 put16(&q, 0xe000 | service->pcr_pid);
00198
00199 program_info_length_ptr = q;
00200 q += 2;
00201
00202
00203
00204 val = 0xf000 | (q - program_info_length_ptr - 2);
00205 program_info_length_ptr[0] = val >> 8;
00206 program_info_length_ptr[1] = val;
00207
00208 for(i = 0; i < s->nb_streams; i++) {
00209 AVStream *st = s->streams[i];
00210 MpegTSWriteStream *ts_st = st->priv_data;
00211 switch(st->codec->codec_id) {
00212 case CODEC_ID_MPEG1VIDEO:
00213 case CODEC_ID_MPEG2VIDEO:
00214 stream_type = STREAM_TYPE_VIDEO_MPEG2;
00215 break;
00216 case CODEC_ID_MPEG4:
00217 stream_type = STREAM_TYPE_VIDEO_MPEG4;
00218 break;
00219 case CODEC_ID_H264:
00220 stream_type = STREAM_TYPE_VIDEO_H264;
00221 break;
00222 case CODEC_ID_MP2:
00223 case CODEC_ID_MP3:
00224 stream_type = STREAM_TYPE_AUDIO_MPEG1;
00225 break;
00226 case CODEC_ID_AAC:
00227 stream_type = STREAM_TYPE_AUDIO_AAC;
00228 break;
00229 case CODEC_ID_AC3:
00230 stream_type = STREAM_TYPE_AUDIO_AC3;
00231 break;
00232 default:
00233 stream_type = STREAM_TYPE_PRIVATE_DATA;
00234 break;
00235 }
00236 *q++ = stream_type;
00237 put16(&q, 0xe000 | ts_st->pid);
00238 desc_length_ptr = q;
00239 q += 2;
00240
00241
00242 switch(st->codec->codec_type) {
00243 case CODEC_TYPE_AUDIO:
00244 if (strlen(st->language) == 3) {
00245 *q++ = 0x0a;
00246 *q++ = 4;
00247 *q++ = st->language[0];
00248 *q++ = st->language[1];
00249 *q++ = st->language[2];
00250 *q++ = 0;
00251 }
00252 break;
00253 case CODEC_TYPE_SUBTITLE:
00254 {
00255 const char *language;
00256 language = st->language;
00257 if (strlen(language) != 3)
00258 language = "eng";
00259 *q++ = 0x59;
00260 *q++ = 8;
00261 *q++ = language[0];
00262 *q++ = language[1];
00263 *q++ = language[2];
00264 *q++ = 0x10;
00265 put16(&q, 1);
00266 put16(&q, 1);
00267 }
00268 break;
00269 }
00270
00271 val = 0xf000 | (q - desc_length_ptr - 2);
00272 desc_length_ptr[0] = val >> 8;
00273 desc_length_ptr[1] = val;
00274 }
00275 mpegts_write_section1(&service->pmt, PMT_TID, service->sid, 0, 0, 0,
00276 data, q - data);
00277 }
00278
00279
00280 static void putstr8(uint8_t **q_ptr, const char *str)
00281 {
00282 uint8_t *q;
00283 int len;
00284
00285 q = *q_ptr;
00286 if (!str)
00287 len = 0;
00288 else
00289 len = strlen(str);
00290 *q++ = len;
00291 memcpy(q, str, len);
00292 q += len;
00293 *q_ptr = q;
00294 }
00295
00296 static void mpegts_write_sdt(AVFormatContext *s)
00297 {
00298 MpegTSWrite *ts = s->priv_data;
00299 MpegTSService *service;
00300 uint8_t data[1012], *q, *desc_list_len_ptr, *desc_len_ptr;
00301 int i, running_status, free_ca_mode, val;
00302
00303 q = data;
00304 put16(&q, ts->onid);
00305 *q++ = 0xff;
00306 for(i = 0; i < ts->nb_services; i++) {
00307 service = ts->services[i];
00308 put16(&q, service->sid);
00309 *q++ = 0xfc | 0x00;
00310 desc_list_len_ptr = q;
00311 q += 2;
00312 running_status = 4;
00313 free_ca_mode = 0;
00314
00315
00316 *q++ = 0x48;
00317 desc_len_ptr = q;
00318 q++;
00319 *q++ = 0x01;
00320 putstr8(&q, service->provider_name);
00321 putstr8(&q, service->name);
00322 desc_len_ptr[0] = q - desc_len_ptr - 1;
00323
00324
00325 val = (running_status << 13) | (free_ca_mode << 12) |
00326 (q - desc_list_len_ptr - 2);
00327 desc_list_len_ptr[0] = val >> 8;
00328 desc_list_len_ptr[1] = val;
00329 }
00330 mpegts_write_section1(&ts->sdt, SDT_TID, ts->tsid, 0, 0, 0,
00331 data, q - data);
00332 }
00333
00334 static MpegTSService *mpegts_add_service(MpegTSWrite *ts,
00335 int sid,
00336 const char *provider_name,
00337 const char *name)
00338 {
00339 MpegTSService *service;
00340
00341 service = av_mallocz(sizeof(MpegTSService));
00342 if (!service)
00343 return NULL;
00344 service->pmt.pid = DEFAULT_PMT_START_PID + ts->nb_services - 1;
00345 service->sid = sid;
00346 service->provider_name = av_strdup(provider_name);
00347 service->name = av_strdup(name);
00348 service->pcr_pid = 0x1fff;
00349 dynarray_add(&ts->services, &ts->nb_services, service);
00350 return service;
00351 }
00352
00353 static void section_write_packet(MpegTSSection *s, const uint8_t *packet)
00354 {
00355 AVFormatContext *ctx = s->opaque;
00356 put_buffer(ctx->pb, packet, TS_PACKET_SIZE);
00357 }
00358
00359 static int mpegts_write_header(AVFormatContext *s)
00360 {
00361 MpegTSWrite *ts = s->priv_data;
00362 MpegTSWriteStream *ts_st;
00363 MpegTSService *service;
00364 AVStream *st;
00365 int i, total_bit_rate;
00366 const char *service_name;
00367
00368 ts->tsid = DEFAULT_TSID;
00369 ts->onid = DEFAULT_ONID;
00370
00371 service_name = s->title;
00372 if (service_name[0] == '\0')
00373 service_name = DEFAULT_SERVICE_NAME;
00374 service = mpegts_add_service(ts, DEFAULT_SID,
00375 DEFAULT_PROVIDER_NAME, service_name);
00376 service->pmt.write_packet = section_write_packet;
00377 service->pmt.opaque = s;
00378
00379 ts->pat.pid = PAT_PID;
00380 ts->pat.cc = 0;
00381 ts->pat.write_packet = section_write_packet;
00382 ts->pat.opaque = s;
00383
00384 ts->sdt.pid = SDT_PID;
00385 ts->sdt.cc = 0;
00386 ts->sdt.write_packet = section_write_packet;
00387 ts->sdt.opaque = s;
00388
00389
00390 total_bit_rate = 0;
00391 for(i = 0;i < s->nb_streams; i++) {
00392 st = s->streams[i];
00393 ts_st = av_mallocz(sizeof(MpegTSWriteStream));
00394 if (!ts_st)
00395 goto fail;
00396 st->priv_data = ts_st;
00397 ts_st->service = service;
00398 ts_st->pid = DEFAULT_START_PID + i;
00399 ts_st->payload_pts = AV_NOPTS_VALUE;
00400 ts_st->payload_dts = AV_NOPTS_VALUE;
00401
00402 if (st->codec->codec_type == CODEC_TYPE_VIDEO &&
00403 service->pcr_pid == 0x1fff)
00404 service->pcr_pid = ts_st->pid;
00405 total_bit_rate += st->codec->bit_rate;
00406 }
00407
00408
00409 if (service->pcr_pid == 0x1fff && s->nb_streams > 0) {
00410 ts_st = s->streams[0]->priv_data;
00411 service->pcr_pid = ts_st->pid;
00412 }
00413
00414 if (total_bit_rate <= 8 * 1024)
00415 total_bit_rate = 8 * 1024;
00416 service->pcr_packet_freq = (total_bit_rate * PCR_RETRANS_TIME) /
00417 (TS_PACKET_SIZE * 8 * 1000);
00418 ts->sdt_packet_freq = (total_bit_rate * SDT_RETRANS_TIME) /
00419 (TS_PACKET_SIZE * 8 * 1000);
00420 ts->pat_packet_freq = (total_bit_rate * PAT_RETRANS_TIME) /
00421 (TS_PACKET_SIZE * 8 * 1000);
00422 #if 0
00423 printf("%d %d %d\n",
00424 total_bit_rate, ts->sdt_packet_freq, ts->pat_packet_freq);
00425 #endif
00426
00427
00428
00429 mpegts_write_sdt(s);
00430 mpegts_write_pat(s);
00431 for(i = 0; i < ts->nb_services; i++) {
00432 mpegts_write_pmt(s, ts->services[i]);
00433 }
00434 put_flush_packet(s->pb);
00435
00436 return 0;
00437
00438 fail:
00439 for(i = 0;i < s->nb_streams; i++) {
00440 st = s->streams[i];
00441 av_free(st->priv_data);
00442 }
00443 return -1;
00444 }
00445
00446
00447 static void retransmit_si_info(AVFormatContext *s)
00448 {
00449 MpegTSWrite *ts = s->priv_data;
00450 int i;
00451
00452 if (++ts->sdt_packet_count == ts->sdt_packet_freq) {
00453 ts->sdt_packet_count = 0;
00454 mpegts_write_sdt(s);
00455 }
00456 if (++ts->pat_packet_count == ts->pat_packet_freq) {
00457 ts->pat_packet_count = 0;
00458 mpegts_write_pat(s);
00459 for(i = 0; i < ts->nb_services; i++) {
00460 mpegts_write_pmt(s, ts->services[i]);
00461 }
00462 }
00463 }
00464
00465 static void write_pts(uint8_t *q, int fourbits, int64_t pts)
00466 {
00467 int val;
00468
00469 val = fourbits << 4 | (((pts >> 30) & 0x07) << 1) | 1;
00470 *q++ = val;
00471 val = (((pts >> 15) & 0x7fff) << 1) | 1;
00472 *q++ = val >> 8;
00473 *q++ = val;
00474 val = (((pts) & 0x7fff) << 1) | 1;
00475 *q++ = val >> 8;
00476 *q++ = val;
00477 }
00478
00479
00480 static void mpegts_write_pes(AVFormatContext *s, AVStream *st,
00481 const uint8_t *payload, int payload_size,
00482 int64_t pts, int64_t dts)
00483 {
00484 MpegTSWriteStream *ts_st = st->priv_data;
00485 uint8_t buf[TS_PACKET_SIZE];
00486 uint8_t *q;
00487 int val, is_start, len, header_len, write_pcr, private_code, flags;
00488 int afc_len, stuffing_len;
00489 int64_t pcr = -1;
00490
00491 is_start = 1;
00492 while (payload_size > 0) {
00493 retransmit_si_info(s);
00494
00495 write_pcr = 0;
00496 if (ts_st->pid == ts_st->service->pcr_pid) {
00497 ts_st->service->pcr_packet_count++;
00498 if (ts_st->service->pcr_packet_count >=
00499 ts_st->service->pcr_packet_freq) {
00500 ts_st->service->pcr_packet_count = 0;
00501 write_pcr = 1;
00502
00503
00504 pcr = pts;
00505 }
00506 }
00507
00508
00509 q = buf;
00510 *q++ = 0x47;
00511 val = (ts_st->pid >> 8);
00512 if (is_start)
00513 val |= 0x40;
00514 *q++ = val;
00515 *q++ = ts_st->pid;
00516 *q++ = 0x10 | ts_st->cc | (write_pcr ? 0x20 : 0);
00517 ts_st->cc = (ts_st->cc + 1) & 0xf;
00518 if (write_pcr) {
00519 *q++ = 7;
00520 *q++ = 0x10;
00521 *q++ = pcr >> 25;
00522 *q++ = pcr >> 17;
00523 *q++ = pcr >> 9;
00524 *q++ = pcr >> 1;
00525 *q++ = (pcr & 1) << 7;
00526 *q++ = 0;
00527 }
00528 if (is_start) {
00529
00530 *q++ = 0x00;
00531 *q++ = 0x00;
00532 *q++ = 0x01;
00533 private_code = 0;
00534 if (st->codec->codec_type == CODEC_TYPE_VIDEO) {
00535 *q++ = 0xe0;
00536 } else if (st->codec->codec_type == CODEC_TYPE_AUDIO &&
00537 (st->codec->codec_id == CODEC_ID_MP2 ||
00538 st->codec->codec_id == CODEC_ID_MP3)) {
00539 *q++ = 0xc0;
00540 } else {
00541 *q++ = 0xbd;
00542 if (st->codec->codec_type == CODEC_TYPE_SUBTITLE) {
00543 private_code = 0x20;
00544 }
00545 }
00546 header_len = 0;
00547 flags = 0;
00548 if (pts != AV_NOPTS_VALUE) {
00549 header_len += 5;
00550 flags |= 0x80;
00551 }
00552 if (dts != AV_NOPTS_VALUE) {
00553 header_len += 5;
00554 flags |= 0x40;
00555 }
00556 len = payload_size + header_len + 3;
00557 if (private_code != 0)
00558 len++;
00559 *q++ = len >> 8;
00560 *q++ = len;
00561 val = 0x80;
00562
00563 if (st->codec->codec_type == CODEC_TYPE_SUBTITLE)
00564 val |= 0x04;
00565 *q++ = val;
00566 *q++ = flags;
00567 *q++ = header_len;
00568 if (pts != AV_NOPTS_VALUE) {
00569 write_pts(q, flags >> 6, pts);
00570 q += 5;
00571 }
00572 if (dts != AV_NOPTS_VALUE) {
00573 write_pts(q, 1, dts);
00574 q += 5;
00575 }
00576 if (private_code != 0)
00577 *q++ = private_code;
00578 is_start = 0;
00579 }
00580
00581 header_len = q - buf;
00582
00583 len = TS_PACKET_SIZE - header_len;
00584 if (len > payload_size)
00585 len = payload_size;
00586 stuffing_len = TS_PACKET_SIZE - header_len - len;
00587 if (stuffing_len > 0) {
00588
00589 if (buf[3] & 0x20) {
00590
00591 afc_len = buf[4] + 1;
00592 memmove(buf + 4 + afc_len + stuffing_len,
00593 buf + 4 + afc_len,
00594 header_len - (4 + afc_len));
00595 buf[4] += stuffing_len;
00596 memset(buf + 4 + afc_len, 0xff, stuffing_len);
00597 } else {
00598
00599 memmove(buf + 4 + stuffing_len, buf + 4, header_len - 4);
00600 buf[3] |= 0x20;
00601 buf[4] = stuffing_len - 1;
00602 if (stuffing_len >= 2) {
00603 buf[5] = 0x00;
00604 memset(buf + 6, 0xff, stuffing_len - 2);
00605 }
00606 }
00607 }
00608 memcpy(buf + TS_PACKET_SIZE - len, payload, len);
00609 payload += len;
00610 payload_size -= len;
00611 put_buffer(s->pb, buf, TS_PACKET_SIZE);
00612 }
00613 put_flush_packet(s->pb);
00614 }
00615
00616 static int mpegts_write_packet(AVFormatContext *s, AVPacket *pkt)
00617 {
00618 AVStream *st = s->streams[pkt->stream_index];
00619 int size= pkt->size;
00620 uint8_t *buf= pkt->data;
00621 MpegTSWriteStream *ts_st = st->priv_data;
00622 int len, max_payload_size;
00623
00624 if (st->codec->codec_type == CODEC_TYPE_SUBTITLE) {
00625
00626 mpegts_write_pes(s, st, buf, size, pkt->pts, AV_NOPTS_VALUE);
00627 return 0;
00628 }
00629
00630 max_payload_size = DEFAULT_PES_PAYLOAD_SIZE;
00631 while (size > 0) {
00632 len = max_payload_size - ts_st->payload_index;
00633 if (len > size)
00634 len = size;
00635 memcpy(ts_st->payload + ts_st->payload_index, buf, len);
00636 buf += len;
00637 size -= len;
00638 ts_st->payload_index += len;
00639 if (ts_st->payload_pts == AV_NOPTS_VALUE)
00640 ts_st->payload_pts = pkt->pts;
00641 if (ts_st->payload_dts == AV_NOPTS_VALUE)
00642 ts_st->payload_dts = pkt->dts;
00643 if (ts_st->payload_index >= max_payload_size) {
00644 mpegts_write_pes(s, st, ts_st->payload, ts_st->payload_index,
00645 ts_st->payload_pts, ts_st->payload_dts);
00646 ts_st->payload_pts = AV_NOPTS_VALUE;
00647 ts_st->payload_dts = AV_NOPTS_VALUE;
00648 ts_st->payload_index = 0;
00649 }
00650 }
00651 return 0;
00652 }
00653
00654 static int mpegts_write_end(AVFormatContext *s)
00655 {
00656 MpegTSWrite *ts = s->priv_data;
00657 MpegTSWriteStream *ts_st;
00658 MpegTSService *service;
00659 AVStream *st;
00660 int i;
00661
00662
00663 for(i = 0; i < s->nb_streams; i++) {
00664 st = s->streams[i];
00665 ts_st = st->priv_data;
00666 if (ts_st->payload_index > 0) {
00667 mpegts_write_pes(s, st, ts_st->payload, ts_st->payload_index,
00668 ts_st->payload_pts, ts_st->payload_dts);
00669 }
00670 }
00671 put_flush_packet(s->pb);
00672
00673 for(i = 0; i < ts->nb_services; i++) {
00674 service = ts->services[i];
00675 av_freep(&service->provider_name);
00676 av_freep(&service->name);
00677 av_free(service);
00678 }
00679 av_free(ts->services);
00680
00681 return 0;
00682 }
00683
00684 AVOutputFormat mpegts_muxer = {
00685 "mpegts",
00686 "MPEG2 transport stream format",
00687 "video/x-mpegts",
00688 "ts",
00689 sizeof(MpegTSWrite),
00690 CODEC_ID_MP2,
00691 CODEC_ID_MPEG2VIDEO,
00692 mpegts_write_header,
00693 mpegts_write_packet,
00694 mpegts_write_end,
00695 };