ts.c

#include <stdio.h>
#include <stdlib.h>
#include <string.h>

#include "ts.h"

static unsigned int CalcCrc(unsigned int crc, unsigned char *buf, int len);
static int checkcrc(SECcache *secs);

SECcache *readTS(FILE *in, SECcache secs[], int size) {
	static int rcount = 0;
	static int ridx = -1;

	TSpacket pk;

	unsigned char buf[1024];

	int boff;
	int len;
	unsigned char *payptr;

	int inchar;
	int i;

	/* syncバイトまで読み飛ばし */
	if(rcount == 0) {
		while((inchar = fgetc(in)) != EOF) {
			if((inchar & 0xFF) == 0x47) {
				//fseek(in, -1, SEEK_CUR);
				ungetc(inchar, in);
				break;
			}
		}
		if(inchar == EOF) {
			return NULL;
		}
	}

retry:

	/* 戻すべき残りがあるか? */
	if(ridx >= 0 && secs[ridx].cont) {
		/* バッファチェック */
		if((secs[ridx].cur.payload[secs[ridx].curlen] & 0xFF) == 0xFF) {
			secs[ridx].cont = 0;
			secs[ridx].seclen = 0;
			secs[ridx].setlen = 0;
			secs[ridx].curlen = 0;
		} else {
			len = secs[ridx].cur.payloadlen - secs[ridx].curlen;
			/* 全部設定済みチェック */
			if(len == 0) {
				secs[ridx].cont = 0;
				secs[ridx].seclen = 0;
				secs[ridx].setlen = 0;
				secs[ridx].curlen = 0;
			} else {
				/* ここでseclenが跨るようにTS分割されていると困るな @@
				   if(secs[ridx].pid == 0x12) {
				   int check = secs[ridx].cur.payload[secs[ridx].curlen] & 0xFF;
				   if(!(check == 0x4E ||
				   check == 0x4F ||
				   (check >= 0x50 && check <= 0x6F))) {
				   secs[ridx].curlen -= 3;
				   }
				   }
				*/

				boff = 12;
				secs[ridx].seclen = getBit(&secs[ridx].cur.payload[secs[ridx].curlen], &boff, 12) + 3; // ヘッダ

				/*
				  if(secs[ridx].seclen == 2334) {
				  printf("aa");
				  }
				*/

				/* TSデータ長-設定済みデータ長 */
				if(secs[ridx].seclen > len) {
					memcpy(secs[ridx].buf, &secs[ridx].cur.payload[secs[ridx].curlen], len);
					secs[ridx].setlen = len;
					secs[ridx].curlen = 0;
					secs[ridx].cont   = 1;
					/* 次のレコード読み込み */
				} else {
					memcpy(secs[ridx].buf,
						   &secs[ridx].cur.payload[secs[ridx].curlen], secs[ridx].seclen);
					secs[ridx].setlen  = secs[ridx].seclen;
					secs[ridx].curlen += secs[ridx].seclen;
					secs[ridx].cont = 1;

					/* CRCのチェック */
					if(checkcrc(&(secs[ridx]))) {
						return &(secs[ridx]); /* 戻る */
					}
					goto retry; /* もう一回 */
				}
			}
		}
	}

	int roffset = 0;
	while(1) {
		if(fread(buf+roffset, 188-roffset, 1, in) != 1) {
			/* 残りの処理? */
			return NULL;
		}
		roffset = 0;
		rcount++;

		if((buf[0] & 0xFF) != 0x47) {
			/* 最初はbuf中に0x47があるかチェック */
			for(i = 1; i < 188; i++) {
				if((buf[i] & 0xFF) == 0x47) {
					break;
				}
			}

			if(i < 188) {
				/* そこから再読み込みして欲しいのでseek */
				//fseek(in, (188 - i) * -1, SEEK_CUR);
				roffset = i;
				memmove(buf, buf + i, 188 - i);
				continue;
			}

			while((inchar = fgetc(in)) != EOF) {
				if((inchar & 0xFF) == 0x47) {
					//fseek(in, -1, SEEK_CUR);
					ungetc(inchar, in);
					break;
				}
			}
			if(inchar == EOF) {
				return NULL;
			}
			continue;
		}

		/*
		  if(rcount == 406502) {
		  printf("aa");
		  }
		*/


		pk.rcount = rcount;

		boff = 0;
		pk.sync = getBit(buf, &boff, 8);
		pk.transport_error_indicator = getBit(buf, &boff, 1);
		pk.payload_unit_start_indicator = getBit(buf, &boff, 1);
		pk.transport_priority = getBit(buf, &boff, 1);
		pk.pid = getBit(buf, &boff, 13);
		pk.transport_scrambling_control = getBit(buf, &boff, 2);
		pk.adaptation_field_control = getBit(buf, &boff, 2);
		pk.continuity_counter = getBit(buf, &boff, 4);

		/*
		  adaptation_field_control 2 bslbf
		  continuity_counter 4 uimsbf
		  if(adaptation_field_control = = '10' || adaptation_field_control = = '11'){
		  adaptation_field()
		  }
		  ...
		  adaptation_field() {
		  adaptation_field_length 8 uimsbf
		  if (adaptation_field_length > 0) {
		  discontinuity_indicator....

		  00 Reserved for future use by ISO/IEC
		  01 No adaptation_field, payload only
		  10 Adaptation_field only, no payload
		  11 Adaptation_field followed by payload

		*/

		pk.payloadlen = 184;

		if(pk.adaptation_field_control == 2) {
			continue;
		}

		if(pk.adaptation_field_control == 3) {
			len = getBit(buf, &boff, 8);
			payptr = buf + (boff / 8) + len;
			pk.payloadlen -= (len + 1);
		} else {
			payptr = buf + (boff / 8);
		}
		if(pk.payloadlen < 0){
			continue ;
		}

		/*
		   if the Transport Stream packet carries the first byte of a PSI section, the payload_unit_start_indicator value
		   shall be '1', indicating that the first byte of the payload of this Transport Stream packet carries the pointer_field.
		*/
		if(pk.payload_unit_start_indicator == 1) {
			/* pointer_fieldはいらない */
			payptr += 1;
			pk.payloadlen -= 1;
		}
		memset(pk.payload, 0xFF, sizeof(pk.payload));
		if(pk.payloadlen > sizeof(pk.payload))
			continue;
		memcpy(pk.payload, payptr, pk.payloadlen);


		/*
		  if(pk.rcount == 62) {
		  printf("62\n");
		  }

		  if(pk.rcount == 63) {
		  printf("63\n");
		  }
		*/

		/* 興味のあるpidか確認 */
		for(int i = 0;i < size; i++) {
			if(secs[i].pid == pk.pid) {
				secs[i].cur = pk;
				/* 途中処理中か最初か? */
				if(!secs[i].cont) {
					/* 最初 セクション長を調べる */
					boff = 12;
					secs[i].seclen = getBit(secs[i].cur.payload, &boff, 12) + 3; // ヘッダ;
					/*
					  if(secs[i].seclen == 2334) {
					  printf("aa");
					  }
					*/

					if(secs[i].seclen > secs[i].cur.payloadlen) {
						memcpy(secs[i].buf, secs[i].cur.payload, secs[i].cur.payloadlen);
						secs[i].setlen = secs[i].cur.payloadlen;
						secs[i].cont = 1;
						continue;
					}
					memcpy(secs[i].buf, secs[i].cur.payload, secs[i].seclen);
					secs[i].setlen = secs[i].seclen;
					secs[i].curlen = secs[i].seclen;
					secs[i].cont = 1;
					ridx = i;
					/* CRCのチェック */
					if(checkcrc(&(secs[ridx]))) {
						return &(secs[i]); /* 取り合えず戻る */
					}
					goto retry; /* 残り処理へ */
				}
				/* セクション長-設定済み長 */
				len = secs[i].seclen - secs[i].setlen;
				if(len > secs[i].cur.payloadlen) {
					/* 全体転送 */
					memcpy(&secs[i].buf[secs[i].setlen],
						   secs[i].cur.payload, secs[i].cur.payloadlen);
					secs[i].setlen += secs[i].cur.payloadlen;
					continue;
				}
				/* セクション長の残りを設定 */
				memcpy(&secs[i].buf[secs[i].setlen], secs[i].cur.payload, len);
				secs[i].setlen  = secs[i].seclen;
				secs[i].curlen += len;
				secs[i].cont    = 1;
				ridx = i;
				/* CRCのチェック */
				if(checkcrc(&(secs[ridx]))) {
					return &(secs[i]);
				}
				goto retry; /* 残り処理へ */
			}
		}
	}

	//return NULL;
}

/* BonTest/TsStream.cppからのパクリ */
unsigned int CalcCrc(unsigned int crc, unsigned char *buf, int len) {
	unsigned int c = crc;
	int n;

	static const unsigned int CrcTable[256] = {
		0x00000000UL, 0x04C11DB7UL, 0x09823B6EUL, 0x0D4326D9UL,	0x130476DCUL, 0x17C56B6BUL, 0x1A864DB2UL, 0x1E475005UL,	0x2608EDB8UL, 0x22C9F00FUL, 0x2F8AD6D6UL, 0x2B4BCB61UL,	0x350C9B64UL, 0x31CD86D3UL, 0x3C8EA00AUL, 0x384FBDBDUL,
		0x4C11DB70UL, 0x48D0C6C7UL, 0x4593E01EUL, 0x4152FDA9UL,	0x5F15ADACUL, 0x5BD4B01BUL, 0x569796C2UL, 0x52568B75UL,	0x6A1936C8UL, 0x6ED82B7FUL, 0x639B0DA6UL, 0x675A1011UL,	0x791D4014UL, 0x7DDC5DA3UL, 0x709F7B7AUL, 0x745E66CDUL,
		0x9823B6E0UL, 0x9CE2AB57UL, 0x91A18D8EUL, 0x95609039UL,	0x8B27C03CUL, 0x8FE6DD8BUL, 0x82A5FB52UL, 0x8664E6E5UL,	0xBE2B5B58UL, 0xBAEA46EFUL, 0xB7A96036UL, 0xB3687D81UL,	0xAD2F2D84UL, 0xA9EE3033UL, 0xA4AD16EAUL, 0xA06C0B5DUL,
		0xD4326D90UL, 0xD0F37027UL, 0xDDB056FEUL, 0xD9714B49UL,	0xC7361B4CUL, 0xC3F706FBUL, 0xCEB42022UL, 0xCA753D95UL,	0xF23A8028UL, 0xF6FB9D9FUL, 0xFBB8BB46UL, 0xFF79A6F1UL,	0xE13EF6F4UL, 0xE5FFEB43UL, 0xE8BCCD9AUL, 0xEC7DD02DUL,
		0x34867077UL, 0x30476DC0UL, 0x3D044B19UL, 0x39C556AEUL,	0x278206ABUL, 0x23431B1CUL, 0x2E003DC5UL, 0x2AC12072UL,	0x128E9DCFUL, 0x164F8078UL, 0x1B0CA6A1UL, 0x1FCDBB16UL,	0x018AEB13UL, 0x054BF6A4UL, 0x0808D07DUL, 0x0CC9CDCAUL,
		0x7897AB07UL, 0x7C56B6B0UL, 0x71159069UL, 0x75D48DDEUL,	0x6B93DDDBUL, 0x6F52C06CUL, 0x6211E6B5UL, 0x66D0FB02UL,	0x5E9F46BFUL, 0x5A5E5B08UL, 0x571D7DD1UL, 0x53DC6066UL,	0x4D9B3063UL, 0x495A2DD4UL, 0x44190B0DUL, 0x40D816BAUL,
		0xACA5C697UL, 0xA864DB20UL, 0xA527FDF9UL, 0xA1E6E04EUL,	0xBFA1B04BUL, 0xBB60ADFCUL, 0xB6238B25UL, 0xB2E29692UL,	0x8AAD2B2FUL, 0x8E6C3698UL, 0x832F1041UL, 0x87EE0DF6UL,	0x99A95DF3UL, 0x9D684044UL, 0x902B669DUL, 0x94EA7B2AUL,
		0xE0B41DE7UL, 0xE4750050UL, 0xE9362689UL, 0xEDF73B3EUL,	0xF3B06B3BUL, 0xF771768CUL, 0xFA325055UL, 0xFEF34DE2UL,	0xC6BCF05FUL, 0xC27DEDE8UL, 0xCF3ECB31UL, 0xCBFFD686UL,	0xD5B88683UL, 0xD1799B34UL, 0xDC3ABDEDUL, 0xD8FBA05AUL,
		0x690CE0EEUL, 0x6DCDFD59UL, 0x608EDB80UL, 0x644FC637UL,	0x7A089632UL, 0x7EC98B85UL, 0x738AAD5CUL, 0x774BB0EBUL,	0x4F040D56UL, 0x4BC510E1UL, 0x46863638UL, 0x42472B8FUL,	0x5C007B8AUL, 0x58C1663DUL, 0x558240E4UL, 0x51435D53UL,
		0x251D3B9EUL, 0x21DC2629UL, 0x2C9F00F0UL, 0x285E1D47UL,	0x36194D42UL, 0x32D850F5UL, 0x3F9B762CUL, 0x3B5A6B9BUL,	0x0315D626UL, 0x07D4CB91UL, 0x0A97ED48UL, 0x0E56F0FFUL,	0x1011A0FAUL, 0x14D0BD4DUL, 0x19939B94UL, 0x1D528623UL,
		0xF12F560EUL, 0xF5EE4BB9UL, 0xF8AD6D60UL, 0xFC6C70D7UL,	0xE22B20D2UL, 0xE6EA3D65UL, 0xEBA91BBCUL, 0xEF68060BUL,	0xD727BBB6UL, 0xD3E6A601UL, 0xDEA580D8UL, 0xDA649D6FUL,	0xC423CD6AUL, 0xC0E2D0DDUL, 0xCDA1F604UL, 0xC960EBB3UL,
		0xBD3E8D7EUL, 0xB9FF90C9UL, 0xB4BCB610UL, 0xB07DABA7UL,	0xAE3AFBA2UL, 0xAAFBE615UL, 0xA7B8C0CCUL, 0xA379DD7BUL,	0x9B3660C6UL, 0x9FF77D71UL, 0x92B45BA8UL, 0x9675461FUL,	0x8832161AUL, 0x8CF30BADUL, 0x81B02D74UL, 0x857130C3UL,
		0x5D8A9099UL, 0x594B8D2EUL, 0x5408ABF7UL, 0x50C9B640UL,	0x4E8EE645UL, 0x4A4FFBF2UL, 0x470CDD2BUL, 0x43CDC09CUL,	0x7B827D21UL, 0x7F436096UL, 0x7200464FUL, 0x76C15BF8UL,	0x68860BFDUL, 0x6C47164AUL, 0x61043093UL, 0x65C52D24UL,
		0x119B4BE9UL, 0x155A565EUL, 0x18197087UL, 0x1CD86D30UL,	0x029F3D35UL, 0x065E2082UL, 0x0B1D065BUL, 0x0FDC1BECUL,	0x3793A651UL, 0x3352BBE6UL, 0x3E119D3FUL, 0x3AD08088UL,	0x2497D08DUL, 0x2056CD3AUL, 0x2D15EBE3UL, 0x29D4F654UL,
		0xC5A92679UL, 0xC1683BCEUL, 0xCC2B1D17UL, 0xC8EA00A0UL,	0xD6AD50A5UL, 0xD26C4D12UL, 0xDF2F6BCBUL, 0xDBEE767CUL,	0xE3A1CBC1UL, 0xE760D676UL, 0xEA23F0AFUL, 0xEEE2ED18UL,	0xF0A5BD1DUL, 0xF464A0AAUL, 0xF9278673UL, 0xFDE69BC4UL,
		0x89B8FD09UL, 0x8D79E0BEUL, 0x803AC667UL, 0x84FBDBD0UL,	0x9ABC8BD5UL, 0x9E7D9662UL, 0x933EB0BBUL, 0x97FFAD0CUL,	0xAFB010B1UL, 0xAB710D06UL, 0xA6322BDFUL, 0xA2F33668UL,	0xBCB4666DUL, 0xB8757BDAUL, 0xB5365D03UL, 0xB1F740B4UL
	};

	for (n = 0; n < len; n++) {
		c = (c << 8) ^ CrcTable[((((c >> 24) & 0xFF) ^ buf[n]) & 0XFF)];
	}

	return c;
}


int checkcrc(SECcache *secs) {

	/* regard a section with more than MAXSECLEN data as an error. */
	if(secs->seclen > MAXSECLEN) {
		return 0;
	}

	/* セクションの終りに置かれる4バイトのCRC32は、
	   CRC計算の結果0になるように設定される。
	   値が発生した場合は、エラーなので対象外にする */
	if(CalcCrc(0xffffffffU, secs->buf, secs->seclen)) {
//		fprintf(stderr, "tblid:0x%x CRC error\n", secs->buf[0]);
		return 0;
	}
	return 1;
}