📄 dabemu.cpp
字号:
/*
*
*/
#include <stdio.h>
#include <string.h>
#include "DABEmu.h"
#ifdef __linux__
#include <unistd.h>
#include "cmmbspi.h"
#include "cmmbdemodulatorconfig.h"
#endif
#define READBLOCKSIZE (256000)
FILE * pfInputFile = NULL;
/////////////////////////////////////////////////////////////////////////
int g_streamspi = 0;
#define MAX_SUBFRAME_NUM 15
typedef struct
{
UInt32 u32Inicode; // 帧起始码 32位
UInt8 u8Headlen; // 头长度 8
UInt8 Version; // 版本号 5
UInt8 u8Minversion; // 最小版本号 5
UInt8 u8MF_ID; // 复用帧标识 6
UInt8 u8CST; // 紧急广播指示 2
UInt8 u8NextPara; // 下一帧参数指示 1
UInt8 u8Reserve1; // 保留位3
UInt8 u8Update; // 更新序号生效标志 2
UInt8 u8NIT; // 网络信息表更新序号 4
UInt8 u8CMCT; // 持续业务复用配置表更新序号 4
UInt8 u8CSCT; // 持续业务配置表更新序号 4
UInt8 u8DMCT; // 短时间业务复用配置表更新序号 4
UInt8 u8DSCT; // 短时间业务配置表更新序号 4
UInt8 u8ESG; // 4
UInt8 u8Reserve2; // 保留位4
UInt8 u8SubFrameNum; // 复用子帧数4
UInt32 u32SubFrame1Len; // 复用子帧1长度 24
UInt32 u32SubFrameLen[MAX_SUBFRAME_NUM];
UInt8 u8NextParaC[5]; // 下一帧参数40位
UInt32 u32CRC; // CRC 32
}Head;
Head m_head;
static unsigned long crc32_table[256] =
{
0x00000000, 0x04C11DB7, 0x09823B6E, 0x0D4326D9, 0x130476DC, 0x17C56B6B, 0x1A864DB2, 0x1E475005,
0x2608EDB8, 0x22C9F00F, 0x2F8AD6D6, 0x2B4BCB61, 0x350C9B64, 0x31CD86D3, 0x3C8EA00A, 0x384FBDBD,
0x4C11DB70, 0x48D0C6C7, 0x4593E01E, 0x4152FDA9, 0x5F15ADAC, 0x5BD4B01B, 0x569796C2, 0x52568B75,
0x6A1936C8, 0x6ED82B7F, 0x639B0DA6, 0x675A1011, 0x791D4014, 0x7DDC5DA3, 0x709F7B7A, 0x745E66CD,
0x9823B6E0, 0x9CE2AB57, 0x91A18D8E, 0x95609039, 0x8B27C03C, 0x8FE6DD8B, 0x82A5FB52, 0x8664E6E5,
0xBE2B5B58, 0xBAEA46EF, 0xB7A96036, 0xB3687D81, 0xAD2F2D84, 0xA9EE3033, 0xA4AD16EA, 0xA06C0B5D,
0xD4326D90, 0xD0F37027, 0xDDB056FE, 0xD9714B49, 0xC7361B4C, 0xC3F706FB, 0xCEB42022, 0xCA753D95,
0xF23A8028, 0xF6FB9D9F, 0xFBB8BB46, 0xFF79A6F1, 0xE13EF6F4, 0xE5FFEB43, 0xE8BCCD9A, 0xEC7DD02D,
0x34867077, 0x30476DC0, 0x3D044B19, 0x39C556AE, 0x278206AB, 0x23431B1C, 0x2E003DC5, 0x2AC12072,
0x128E9DCF, 0x164F8078, 0x1B0CA6A1, 0x1FCDBB16, 0x018AEB13, 0x054BF6A4, 0x0808D07D, 0x0CC9CDCA,
0x7897AB07, 0x7C56B6B0, 0x71159069, 0x75D48DDE, 0x6B93DDDB, 0x6F52C06C, 0x6211E6B5, 0x66D0FB02,
0x5E9F46BF, 0x5A5E5B08, 0x571D7DD1, 0x53DC6066, 0x4D9B3063, 0x495A2DD4, 0x44190B0D, 0x40D816BA,
0xACA5C697, 0xA864DB20, 0xA527FDF9, 0xA1E6E04E, 0xBFA1B04B, 0xBB60ADFC, 0xB6238B25, 0xB2E29692,
0x8AAD2B2F, 0x8E6C3698, 0x832F1041, 0x87EE0DF6, 0x99A95DF3, 0x9D684044, 0x902B669D, 0x94EA7B2A,
0xE0B41DE7, 0xE4750050, 0xE9362689, 0xEDF73B3E, 0xF3B06B3B, 0xF771768C, 0xFA325055, 0xFEF34DE2,
0xC6BCF05F, 0xC27DEDE8, 0xCF3ECB31, 0xCBFFD686, 0xD5B88683, 0xD1799B34, 0xDC3ABDED, 0xD8FBA05A,
0x690CE0EE, 0x6DCDFD59, 0x608EDB80, 0x644FC637, 0x7A089632, 0x7EC98B85, 0x738AAD5C, 0x774BB0EB,
0x4F040D56, 0x4BC510E1, 0x46863638, 0x42472B8F, 0x5C007B8A, 0x58C1663D, 0x558240E4, 0x51435D53,
0x251D3B9E, 0x21DC2629, 0x2C9F00F0, 0x285E1D47, 0x36194D42, 0x32D850F5, 0x3F9B762C, 0x3B5A6B9B,
0x0315D626, 0x07D4CB91, 0x0A97ED48, 0x0E56F0FF, 0x1011A0FA, 0x14D0BD4D, 0x19939B94, 0x1D528623,
0xF12F560E, 0xF5EE4BB9, 0xF8AD6D60, 0xFC6C70D7, 0xE22B20D2, 0xE6EA3D65, 0xEBA91BBC, 0xEF68060B,
0xD727BBB6, 0xD3E6A601, 0xDEA580D8, 0xDA649D6F, 0xC423CD6A, 0xC0E2D0DD, 0xCDA1F604, 0xC960EBB3,
0xBD3E8D7E, 0xB9FF90C9, 0xB4BCB610, 0xB07DABA7, 0xAE3AFBA2, 0xAAFBE615, 0xA7B8C0CC, 0xA379DD7B,
0x9B3660C6, 0x9FF77D71, 0x92B45BA8, 0x9675461F, 0x8832161A, 0x8CF30BAD, 0x81B02D74, 0x857130C3,
0x5D8A9099, 0x594B8D2E, 0x5408ABF7, 0x50C9B640, 0x4E8EE645, 0x4A4FFBF2, 0x470CDD2B, 0x43CDC09C,
0x7B827D21, 0x7F436096, 0x7200464F, 0x76C15BF8, 0x68860BFD, 0x6C47164A, 0x61043093, 0x65C52D24,
0x119B4BE9, 0x155A565E, 0x18197087, 0x1CD86D30, 0x029F3D35, 0x065E2082, 0x0B1D065B, 0x0FDC1BEC,
0x3793A651, 0x3352BBE6, 0x3E119D3F, 0x3AD08088, 0x2497D08D, 0x2056CD3A, 0x2D15EBE3, 0x29D4F654,
0xC5A92679, 0xC1683BCE, 0xCC2B1D17, 0xC8EA00A0, 0xD6AD50A5, 0xD26C4D12, 0xDF2F6BCB, 0xDBEE767C,
0xE3A1CBC1, 0xE760D676, 0xEA23F0AF, 0xEEE2ED18, 0xF0A5BD1D, 0xF464A0AA, 0xF9278673, 0xFDE69BC4,
0x89B8FD09, 0x8D79E0BE, 0x803AC667, 0x84FBDBD0, 0x9ABC8BD5, 0x9E7D9662, 0x933EB0BB, 0x97FFAD0C,
0xAFB010B1, 0xAB710D06, 0xA6322BDF, 0xA2F33668, 0xBCB4666D, 0xB8757BDA, 0xB5365D03, 0xB1F740B4,
};
static unsigned long CalcCRC32(UInt8* inData, unsigned long inLen)
{
unsigned long dwRegister = 0xFFFFFFFF;
for( unsigned long i=0 ; i<inLen ; i++ )
{
dwRegister = ((dwRegister) << 8) ^
crc32_table[(inData[i]) ^ ((dwRegister>>24) & 0x000000FF)];
}
return dwRegister;
};
/*******************************************************************************
* 函数名称 : valuetwo
* 作 者 : 林亚
* 设计日期 : 2006年9月26日
* 功能描述 : 得到2个字节的网络字节序的数值
* 参 数 : UInt8 *pv
* 返 回 值 : inline UInt32
*******************************************************************************/
UInt16 valuetwo(UInt8* pv)
{
UInt16 u16value = 0;
u16value = (*pv) << 8;
pv++;
u16value |= (*pv);
return (u16value);
};
/*******************************************************************************
* 函数名称 : valuethree
* 作 者 : 林亚
* 设计日期 : 2006年9月26日
* 功能描述 : 得到3个字节的网络字节序的数值
* 参 数 : UInt8 *pv
* 返 回 值 : inline UInt32
*******************************************************************************/
UInt32 valuethree(UInt8* pv)
{
UInt32 u32value = 0;
u32value = (*pv) << 16;
pv++;
u32value |= (*pv) << 8;
pv++;
u32value |= (*pv);
return (u32value);
};
/*******************************************************************************
* 函数名称 : valuefour
* 作 者 : 林亚
* 设计日期 : 2006年9月26日
* 功能描述 : 得到4个字节的网络字节序的数值
* 参 数 : UInt8 *pv
* 返 回 值 : inline UInt32
*******************************************************************************/
UInt32 valuefour(UInt8* pv)
{
UInt32 u32value = 0;
u32value = (*pv) << 24;
pv ++;
u32value |= (*pv) << 16;
pv++;
u32value |= (*pv) << 8;
pv++;
u32value |= (*pv);
return (u32value);
};
#ifdef __linux__
// 1
//2
//startdemodulatorSPI();
// 3
//writeI2CData(2, 601 /* 602, 603*/);
// 4
void startSPI()
{
if (g_streamspi > 0)
{
closeSPI(g_streamspi);
g_streamspi = 0;
}
if (g_streamspi == 0)
{
g_streamspi = openSPI("/dev/tv_stream",O_RDONLY);
printf("xingxing : g_streamspi:%d----------\n",g_streamspi);
if (g_streamspi<0)
{
printf("xingxing : Open tv_stream error, g_streamspi=%d\n", g_streamspi);
}
}
}
// 5
void stopSPI()
{
if (g_streamspi > 0)
{
closeSPI(g_streamspi);
g_streamspi = 0;
printf("xingxing : close(g_streamspi) suecss\n");
}
}
// 6
// stopdemodulatorSPI();
#endif
UInt32 GetSubFrameLen(UInt8* pinSubHead)
{
UInt8 u8Temp = 0;
UInt8 u8HeadLen = 0;
UInt8 u8IniTimeFlag = 0;
UInt8 u8Len_VFlag = 0;
UInt8 u8Len_AFlag = 0;
UInt8 u8Len_DFlag = 0;
UInt32 u32VideoLen = 0;
UInt32 u32AudioLen = 0;
UInt32 u32DataLen = 0;
UInt32 u32SubFrameLen = 0;
UInt32 u32Temp = 0;
u8HeadLen = *pinSubHead;
pinSubHead += 1;
u8Temp = *pinSubHead;
u8IniTimeFlag = (u8Temp & 0x80) >> 7;
u8Len_VFlag = (u8Temp & 0x40) >> 6;
u8Len_AFlag = (u8Temp & 0x20) >> 5;
u8Len_DFlag = (u8Temp & 0x10) >> 4;
pinSubHead += 1;
if ( 1 == u8IniTimeFlag)
{
pinSubHead += 4;
}
if ( 1 == u8Len_VFlag )
{
u32Temp = valuethree(pinSubHead);
u32VideoLen = (u32Temp & 0xFFFFF8) >> 3; // 视频段长度 21位
pinSubHead += 3;
}
if ( 1 == u8Len_AFlag)
{
u32Temp = valuethree(pinSubHead);
u32AudioLen = (u32Temp & 0xFFFFF8) >> 3; // 音频段长度 21位
pinSubHead += 3;
}
if ( 1 == u8Len_DFlag)
{
u32Temp = valuethree(pinSubHead);
u32DataLen = (u32Temp & 0xFFFFF8) >> 3; // 数据段长度 21位
}
u32SubFrameLen = u8HeadLen + 4 + u32VideoLen + u32AudioLen + u32DataLen;
return u32SubFrameLen;
}
#ifdef __linux__
typedef enum
{
E_SUM2_ERROR = -2,
E_SUM1_ERROR,
E_DATA_ERROR,
E_NO_DATA,
}E_CALLBACK_ERROR_RET;
//#define SUBFRAME_FILE
extern FILE *pFile;
int GetNextSubFrameforCallBack(int ispi, UInt8* ioU8Buffer, int& ioffset)
{
UInt32 u32FrameLen = 0;
UInt32 u32AllSubFrameLen = 0;
MUX_Status istatus = MUX_ERROR;
UInt8 u8HeadLen = 0;
istatus = GetNextFramebySPI(ispi, ioU8Buffer, u32FrameLen);
if (istatus == MUX_ERROR_NONE)
{
return -2;
}
else if (istatus == MUX_ERROR)
{
return -1;
}
u8HeadLen = GetHeadLen(ioU8Buffer);
if (!HeadParser(ioU8Buffer))
{
return -1;
}
ioU8Buffer += u8HeadLen;
ioffset += u8HeadLen;
for (int i = 0; i < m_head.u8SubFrameNum; i++)
{
if (m_head.u8MF_ID == 0)
{
// g_TS0Sucessflag = 3;
// istatus = ParseMf0(ioU8Buffer);
// ioU8Buffer += m_head.u32SubFrameLen[i];
return 1;
}
else
{
u32AllSubFrameLen = m_head.u32SubFrameLen[i];
}
}
if (istatus == MUX_FRAME0)
{
return 1;
}
return u32AllSubFrameLen;
}
MUX_Status GetNextFramebySPI(int ispi, UInt8* ioU8Buffer, UInt32& ioU32BufferLen)
{
UInt32 u32BufferOffset = 0;
UInt8 u8HeaderLen = 0;
UInt32 u32AllSubFrameLen = 0;
int iLen = 0;
UInt32 u32Tmp = 0;
UInt32 u32HeadTmp = 0;
UInt8* pTmp = NULL;
UInt8 u8Head = 0;
//unsigned char buffer[6];
// Read PreHeader
while (true)
{
iLen = readSPI(ispi, (char *)(ioU8Buffer + u32BufferOffset), 1);
if ((iLen == 0) || (iLen < 0))
{
ioU32BufferLen = 0;
return MUX_ERROR_NONE;
}
pTmp = ioU8Buffer;
u8Head = *pTmp;
if (u8Head != 0x00)
{
u32BufferOffset = 0;
}
else
{
break;
}
}
u32BufferOffset += 1;
iLen = readSPI(ispi, (char *)(ioU8Buffer + u32BufferOffset), 4);
if (ioU8Buffer[1] != 0x00 || ioU8Buffer[2] != 0x00 || ioU8Buffer[3] != 0x01)
{
return MUX_ERROR;
}
u32BufferOffset += 4;
u8HeaderLen = GetHeadLen(ioU8Buffer);
// Read Complete Header
u32HeadTmp = u8HeaderLen - 5;
iLen = readSPI(ispi, (char *)(ioU8Buffer + u32BufferOffset), u32HeadTmp);
u32Tmp = iLen;
while (u32Tmp < u32HeadTmp)
{
iLen = readSPI(ispi, (char *)(ioU8Buffer + u32BufferOffset + u32Tmp), u32HeadTmp - u32Tmp);
u32Tmp += iLen;
}
u32BufferOffset += u32HeadTmp;
u32AllSubFrameLen = GetFrameLen(ioU8Buffer);
if (u32AllSubFrameLen > 256000)
{
return MUX_ERROR;
}
iLen = readSPI(ispi, (char *)(ioU8Buffer + u32BufferOffset), u32AllSubFrameLen);
u32Tmp = iLen;
while (u32Tmp < u32AllSubFrameLen)
{
iLen = readSPI(ispi, (char *)(ioU8Buffer + u32BufferOffset + u32Tmp), u32AllSubFrameLen - u32Tmp);
u32Tmp += iLen;
}
u32BufferOffset += u32AllSubFrameLen;
ioU32BufferLen = u32BufferOffset; // 第一帧总长度
return MUX_SUCCESS;
}
#endif
/*******************************************************************************
* 函数名称 : HeadParser
* 作 者 : 林亚
* 设计日期 : 2006年9月26日
* 功能描述 : 解析复用帧头信息
* 参 数 : UInt8 *pinHead
* 返 回 值 : UInt32 返回该信道的总长度（复用帧头+复用净荷）
*******************************************************************************/
Bool8 HeadParser(UInt8* pinHead)
{
memset(&m_head,0,sizeof(Head));
UInt8 *pStart = pinHead;
UInt32 u32CalcCRC = 0;
UInt32 u32temp = 0;
UInt32 u32i = 0;
m_head.u32Inicode = valuefour(pinHead); // 帧起始码 32位
pinHead += 4;
m_head.u8Headlen = *pinHead; // 头长度 8位
pinHead += 1;
u32temp = valuetwo(pinHead);
m_head.Version = ((u32temp & 0xF800) >> 11); // 版本号 5位
m_head.u8Minversion = ((u32temp & 0x07C0) >> 6); // 最小版本号 5位
m_head.u8MF_ID = ((u32temp & 0x003F) >> 0); // 复用帧标识 6位
pinHead += 2;
u32temp = *pinHead;
m_head.u8CST = ((u32temp & 0xC0) >> 6); // 紧急广播指示 2位
//XXprintf("xingxing : m_head.u8CST(EB) is %d", m_head.u8CST);
m_head.u8NextPara = ((u32temp & 0x20) >> 5); // 下一帧参数指示 1位
//XXprintf("xingxing : m_head.u8NextPara is %d", m_head.u8NextPara);
m_head.u8Reserve1 = ((u32temp & 0x1C) >> 2); // 保留位 3位
m_head.u8Update = ((u32temp & 0x03) >> 0); // 控制表更新序号提前量指示 2位
//XXprintf("xingxing : m_head.u8Update is %d", m_head.u8Update);
pinHead += 1;
u32temp = *pinHead;
m_head.u8NIT = ((u32temp & 0xF0) >> 4); // 网络信息表更新序号 4位
//XXprintf("xingxing : m_head.u8NIT is %d", m_head.u8NIT);
m_head.u8CMCT = ((u32temp & 0x0F) >> 0); // 持续业务复用配置表更新序号 4位
//XXprintf("xingxing : m_head.u8CMCT is %d", m_head.u8CMCT);
pinHead += 1;
u32temp = *pinHead;
m_head.u8CSCT = ((u32temp & 0xF0) >> 4); // 持续业务配置表更新序号 4位
//XXprintf("xingxing : m_head.u8CSCT is %d", m_head.u8CSCT);
m_head.u8DMCT = ((u32temp & 0x0F) >> 0); // 短时间业务复用配置表更新序号 4位
//XXprintf("xingxing : m_head.u8DMCT is %d", m_head.u8DMCT);
pinHead += 1;
u32temp = *pinHead;
m_head.u8DSCT = ((u32temp & 0xF0) >> 4); // 短时间业务配置表更新序号 4位
//XXprintf("xingxing : m_head.u8DSCT is %d", m_head.u8DSCT);
m_head.u8ESG = ((u32temp & 0x0F) >> 0); // ESG
//XXprintf("xingxing : m_head.u8ESG is %d", m_head.u8ESG);
pinHead += 1;
u32temp = *pinHead;
m_head.u8Reserve2 = ((u32temp & 0xF0) >> 4); // 保留位 4位
m_head.u8SubFrameNum = ((u32temp & 0x0F) >> 0); // 复用子帧数 4位
pinHead += 1;
m_head.u32SubFrame1Len = valuethree(pinHead); // 复用子帧1长度 24位
pinHead += 3;
m_head.u32SubFrameLen[0] = m_head.u32SubFrame1Len;
u32CalcCRC = CalcCRC32(pStart, (m_head.u8Headlen)); //验证校验位，错误则退出
//u32CalcCRC = htonl(u32CalcCRC); //把本机字节序转为网络字节序
pStart += (m_head.u8Headlen);
UInt32 u32CRC = valuefour(pStart);
if (u32CalcCRC != u32CRC)
{
printf("xingxing : Head CRC error!\n");
return false;
}
if (m_head.u8SubFrameNum > 15)
{
printf("xingxing : subframenum greater than 15!\n");
return false;
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -