private void ParseCMCEPDU(LogicChannel channelData, int offset, ReceivedData result)
{
var length = 5;
var type = (CmcePrimitivesType)TetraUtils.BitsToInt32(channelData.Ptr, offset, length);
offset += length;
result.Add(GlobalNames.CMCE_Primitives_Type, (int)type);
//Debug.Write(" " + type.ToString());
switch (type)
{
case CmcePrimitivesType.D_Connect:
Global.ParseParams(channelData, offset, _d_connectRules, result);
break;
case CmcePrimitivesType.D_Setup:
Global.ParseParams(channelData, offset, _d_setupRules, result);
break;
case CmcePrimitivesType.D_TX_Granted:
Global.ParseParams(channelData, offset, _d_TX_GrantedRules, result);
break;
case CmcePrimitivesType.D_TX_Ceased:
Global.ParseParams(channelData, offset, _d_TX_CeasedRules, result);
break;
case CmcePrimitivesType.D_Release:
Global.ParseParams(channelData, offset, _d_ReleaseRules, result);
break;
case CmcePrimitivesType.D_Disconnect:
break;
case CmcePrimitivesType.D_Connect_Acknowledgea:
break;
case CmcePrimitivesType.D_Info:
Global.ParseParams(channelData, offset, _d_infoRules, result);
break;
case CmcePrimitivesType.D_SDS_Data:
offset = Global.ParseParams(channelData, offset, _d_SdsDataRules, result);
if (result.Contains(GlobalNames.User_Defined_Data4_Length))
{
var sdsData = new LogicChannel
{
Ptr = channelData.Ptr + offset,
Length = result.Value(GlobalNames.User_Defined_Data4_Length),
};
_sds.ParseSDS(sdsData, 0, result);
}
break;
case CmcePrimitivesType.D_Alert:
case CmcePrimitivesType.D_Call_Proceeding:
case CmcePrimitivesType.D_Status:
case CmcePrimitivesType.D_TX_Continue:
case CmcePrimitivesType.D_TX_Wait:
case CmcePrimitivesType.D_TX_Interrupt:
case CmcePrimitivesType.D_Call_Restore:
case CmcePrimitivesType.D_Facility:
case CmcePrimitivesType.Reserved17:
case CmcePrimitivesType.Reserved18:
case CmcePrimitivesType.Reserved19:
case CmcePrimitivesType.Reserved20:
case CmcePrimitivesType.Reserved21:
case CmcePrimitivesType.Reserved22:
case CmcePrimitivesType.Reserved23:
case CmcePrimitivesType.Reserved24:
case CmcePrimitivesType.Reserved25:
case CmcePrimitivesType.Reserved26:
case CmcePrimitivesType.Reserved27:
case CmcePrimitivesType.Reserved28:
case CmcePrimitivesType.Reserved29:
case CmcePrimitivesType.Reserved30:
case CmcePrimitivesType.CMCE_Function_Not_Supported:
//Debug.Write(" Unknow_CMCE_SDU");
result.Add(GlobalNames.UnknowData, 1);
break;
}
}
public int Process(Burst burst, float *audioOut)
{
var trafficChannel = 0;
BurstReceived = (burst.Type != BurstType.None);
_timeCounter++;
Ber = _averageBer;
if (_timeCounter > 100)
{
Mer = (_badBurstCounter / _timeCounter) * 100.0f;
_timeCounter = 0;
_badBurstCounter = 0;
}
_networkTime.AddTimeSlot();
if (burst.Type == BurstType.None)
{
_haveErrors = true;
if (TetraMode == Mode.TMO)
{
_badBurstCounter++;
//Debug.WriteLine("burst err");
//Debug.Write(string.Format("ts:{0:0} fr:{1:00} Burst_Err", _networkTime.TimeSlot, _networkTime.Frame));
}
return(trafficChannel);
}
_haveErrors = false;
//Debug.WriteLine("");
//Debug.Write(string.Format("ts:{0:0} fr:{1:00}", _networkTime.TimeSlot, _networkTime.Frame));
//Debug.Write(" " + burst.Type.ToString());
_parse.ResetAACH();
_data.Clear();
_syncInfo.Clear();
#region Sync burst
if (burst.Type == BurstType.SYNC)
{
_phyLevel.ExtractSBChannels(burst, _sb1BufferPtr);
_logicChannel = _lowerMac.ExtractLogicChannelFromSB(_sb1BufferPtr, _sb1Buffer.Length);
_badBurstCounter += _logicChannel.CrcIsOk ? 0.0f : 0.5f;
_haveErrors |= !_logicChannel.CrcIsOk;
_averageBer = _averageBer * 0.5f + _lowerMac.Ber * 0.5f;
//Debug.Write(" slot 1:" + (_logicChannel.CrcIsOk ? " OK" : " Err"));
if (_logicChannel.CrcIsOk)
{
_parse.SyncPDU(_logicChannel, _syncInfo);
if (_syncInfo.Value(GlobalNames.SystemCode) < 8)
{
TetraMode = Mode.TMO;
_lowerMac.ScramblerCode = TetraUtils.CreateScramblerCode(_syncInfo.Value(GlobalNames.MCC), _syncInfo.Value(GlobalNames.MNC), _syncInfo.Value(GlobalNames.ColorCode));
_networkTime.Synchronize(_syncInfo.Value(GlobalNames.TimeSlot), _syncInfo.Value(GlobalNames.Frame), _syncInfo.Value(GlobalNames.MultiFrame));
}
else
{
TetraMode = Mode.DMO;
if (_syncInfo.Value(GlobalNames.SYNC_PDU_type) == 0)
{
//Debug.Write(_syncInfo.Value(GlobalNames.Master_slave_link_flag) == 1 ? " Master" : " Slave");
if (_syncInfo.Value(GlobalNames.Master_slave_link_flag) == 1 || _syncInfo.Value(GlobalNames.Communication_type) == 0)
{
_networkTime.SynchronizeMaster(_syncInfo.Value(GlobalNames.TimeSlot), _syncInfo.Value(GlobalNames.Frame));
}
else
{
_networkTime.SynchronizeSlave(_syncInfo.Value(GlobalNames.TimeSlot), _syncInfo.Value(GlobalNames.Frame));
}
}
}
}
else
{
//Debug.WriteLine("Sync SB crc error");
}
_phyLevel.ExtractPhyChannels(TetraMode, burst, _bbBufferPtr, _bkn1BufferPtr, _bkn2BufferPtr);
if (TetraMode == Mode.TMO)
{
_logicChannel = _lowerMac.ExtractLogicChannelFromBKN(_bkn2BufferPtr, _bkn2Buffer.Length);
_logicChannel.TimeSlot = _networkTime.TimeSlot;
_logicChannel.Frame = _networkTime.Frame;
_badBurstCounter += _logicChannel.CrcIsOk ? 0.0f : 0.5f;
_haveErrors |= !_logicChannel.CrcIsOk;
_averageBer = _averageBer * 0.5f + _lowerMac.Ber * 0.5f;
//Debug.Write(" slot 2:" + (_logicChannel.CrcIsOk ? " OK" : " Err"));
if (_logicChannel.CrcIsOk)
{
_parse.TmoParseMacPDU(_logicChannel, _data);
}
else
{
//Debug.WriteLine("Sync BKN2 crc error");
}
}
else
{
_logicChannel = _lowerMac.ExtractLogicChannelFromBKN2(_bkn2BufferPtr, _bkn2Buffer.Length);
_logicChannel.TimeSlot = _networkTime.TimeSlot;
_logicChannel.Frame = _networkTime.Frame;
_badBurstCounter += _logicChannel.CrcIsOk ? 0.0f : 0.5f;
_haveErrors |= !_logicChannel.CrcIsOk;
_averageBer = _averageBer * 0.5f + _lowerMac.Ber * 0.5f;
//Debug.Write(" slot 2:" + (_logicChannel.CrcIsOk ? " OK" : " Err"));
if (_logicChannel.CrcIsOk)
{
_parse.SyncPDUHalfSlot(_logicChannel, _syncInfo);
if (_syncInfo.Value(GlobalNames.Communication_type) == 0)
{
if (_syncInfo.Contains(GlobalNames.MNC) && _syncInfo.Contains(GlobalNames.Source_address))
{
_lowerMac.ScramblerCode = TetraUtils.CreateScramblerCode(_syncInfo.Value(GlobalNames.MNC), _syncInfo.Value(GlobalNames.Source_address));
}
}
else if (_syncInfo.Value(GlobalNames.Communication_type) == 1)
{
if (_syncInfo.Contains(GlobalNames.Repeater_address) && _syncInfo.Contains(GlobalNames.Source_address))
{
_lowerMac.ScramblerCode = TetraUtils.CreateScramblerCode(_syncInfo.Value(GlobalNames.Repeater_address), _syncInfo.Value(GlobalNames.Source_address));
}
}
}
}
UpdateSyncInfo(_syncInfo);
}
#endregion
UpdatePublicProp();
#region Other burst
if (burst.Type != BurstType.SYNC)
{
_phyLevel.ExtractPhyChannels(TetraMode, burst, _bbBufferPtr, _bkn1BufferPtr, _bkn2BufferPtr);
if (TetraMode == Mode.TMO)
{
_logicChannel = _lowerMac.ExtractLogicChannelFromBB(_bbBufferPtr, _bbBuffer.Length);
_logicChannel.TimeSlot = _networkTime.TimeSlot;
_logicChannel.Frame = _networkTime.Frame;
_badBurstCounter += _logicChannel.CrcIsOk ? 0.0f : 0.2f;
_haveErrors |= !_logicChannel.CrcIsOk;
//Debug.Write(_logicChannel.CrcIsOk ? " BB OK" : " BB Err");
if (_logicChannel.CrcIsOk)
{
_parse.AccessAsignPDU(_logicChannel);
}
else
{
//Debug.WriteLine("BB crc error");
}
}
switch (burst.Type)
{
case BurstType.NDB1:
if (((TetraMode == Mode.TMO) && (_parse.DownLinkChannelType == ChannelType.Traffic)) ||
((TetraMode == Mode.DMO) && (!_networkTime.Frame18) && (_networkTime.TimeSlot == 1)) ||
((TetraMode == Mode.DMO) && (!_networkTime.Frame18Slave) && (_networkTime.TimeSlotSlave == 1)))
{
//Debug.Write(" slot 12:voice");
_logicChannel = _lowerMac.ExtractVoiceDataFromBKN1BKN2(_bkn1BufferPtr, _bkn2BufferPtr, _bkn1Buffer.Length);
var itsAudio = DecodeAudio(audioOut, _logicChannel.Ptr, _logicChannel.Length, false, _networkTime.TimeSlot);
trafficChannel = itsAudio ? _networkTime.TimeSlot : 0;
break;
}
else
{
_logicChannel = _lowerMac.ExtractLogicChannelFromBKN1BKN2(_bkn1BufferPtr, _bkn2BufferPtr, _bkn1Buffer.Length);
_logicChannel.TimeSlot = _networkTime.TimeSlot;
_logicChannel.Frame = _networkTime.Frame;
_badBurstCounter += _logicChannel.CrcIsOk ? 0.0f : 0.8f;
_haveErrors |= !_logicChannel.CrcIsOk;
_averageBer = _averageBer * 0.5f + _lowerMac.Ber * 0.5f;
//Debug.Write(" slot 12:" + (_logicChannel.CrcIsOk ? " OK" : " Err"));
if (_logicChannel.CrcIsOk)
{
if (TetraMode == Mode.TMO)
{
_parse.TmoParseMacPDU(_logicChannel, _data);
}
else
{
_parse.DmoParseMacPDU(_logicChannel, _data);
}
}
else
{
//Debug.WriteLine("BKN1 BKN2 crc error");
}
}
break;
case BurstType.NDB2:
_logicChannel = _lowerMac.ExtractLogicChannelFromBKN(_bkn1BufferPtr, _bkn1Buffer.Length);
_logicChannel.TimeSlot = _networkTime.TimeSlot;
_logicChannel.Frame = _networkTime.Frame;
_badBurstCounter += _logicChannel.CrcIsOk ? 0.0f : 0.4f;
_haveErrors |= !_logicChannel.CrcIsOk;
_averageBer = _averageBer * 0.5f + _lowerMac.Ber * 0.5f;
//Debug.Write(" slot 1:" + (_logicChannel.CrcIsOk ? " OK" : " Err"));
if (_logicChannel.CrcIsOk)
{
if (TetraMode == Mode.TMO)
{
_parse.TmoParseMacPDU(_logicChannel, _data);
}
else
{
_parse.DmoParseMacPDU(_logicChannel, _data);
}
}
else
{
//Debug.WriteLine("BKN1 crc error");
}
if ((_parse.DownLinkChannelType == ChannelType.Traffic && !_parse.HalfSlotStolen) ||
((TetraMode == Mode.DMO) && (!_networkTime.Frame18) && (_networkTime.TimeSlot == 1) && (!_parse.HalfSlotStolen)) ||
((TetraMode == Mode.DMO) && (!_networkTime.Frame18Slave) && (_networkTime.TimeSlotSlave == 1) && (!_parse.HalfSlotStolen)))
{
//Debug.Write(" slot 2:voice");
_logicChannel = _lowerMac.ExtractVoiceDataFromBKN2(_bkn2BufferPtr, _bkn2Buffer.Length);
var itsAudio = DecodeAudio(audioOut, _logicChannel.Ptr, _logicChannel.Length, true, _networkTime.TimeSlot);
trafficChannel = itsAudio ? _networkTime.TimeSlot : 0;
break;
}
else
{
_logicChannel = _lowerMac.ExtractLogicChannelFromBKN(_bkn2BufferPtr, _bkn2Buffer.Length);
_logicChannel.TimeSlot = _networkTime.TimeSlot;
_logicChannel.Frame = _networkTime.Frame;
_badBurstCounter += _logicChannel.CrcIsOk ? 0.0f : 0.4f;
_haveErrors |= !_logicChannel.CrcIsOk;
_averageBer = _averageBer * 0.5f + _lowerMac.Ber * 0.5f;
//Debug.Write(" slot 2:" + (_logicChannel.CrcIsOk ? " OK" : " Err"));
if (_logicChannel.CrcIsOk)
{
if (TetraMode == Mode.TMO)
{
_parse.TmoParseMacPDU(_logicChannel, _data);
}
else
{
_parse.DmoParseMacPDU(_logicChannel, _data);
}
}
else
{
//Debug.WriteLine("BKN2 crc error");
}
}
break;
default:
break;
}
}
if (_data.Count > 0)
{
UpdateData(_data);
}
#endregion
return(trafficChannel);
}
private unsafe void ParseTextMessage(LogicChannel channelData, int offset, ReceivedData result)
{
if (result.Contains(GlobalNames.OutOfBuffer))
{
return;
}
var codingSheme = result.Value(GlobalNames.Text_coding_scheme);
Encoding encTable = Encoding.GetEncoding("iso-8859-1");
int symbLength = 8;
switch (codingSheme)
{
case 1:
encTable = Encoding.GetEncoding("iso-8859-1");
break;
case 2:
encTable = Encoding.GetEncoding("iso-8859-2");
break;
case 3:
encTable = Encoding.GetEncoding("iso-8859-3");
break;
case 4:
encTable = Encoding.GetEncoding("iso-8859-4");
break;
case 5:
encTable = Encoding.GetEncoding("iso-8859-5");
break;
case 6:
encTable = Encoding.GetEncoding("iso-8859-6");
break;
case 7:
encTable = Encoding.GetEncoding("iso-8859-7");
break;
case 8:
encTable = Encoding.GetEncoding("iso-8859-8");
break;
case 9:
encTable = Encoding.GetEncoding("iso-8859-9");
break;
case 10:
encTable = Encoding.GetEncoding("iso-8859-10");
break;
case 11:
encTable = Encoding.GetEncoding("iso-8859-13");
break;
case 12:
encTable = Encoding.GetEncoding("iso-8859-14");
break;
case 13:
encTable = Encoding.GetEncoding("iso-8859-15");
break;
case 14:
encTable = Encoding.GetEncoding(437);
break;
case 15:
encTable = Encoding.GetEncoding(737);
break;
case 16:
encTable = Encoding.GetEncoding(850);
break;
case 17:
encTable = Encoding.GetEncoding(852);
break;
case 18:
encTable = Encoding.GetEncoding(855);
break;
case 19:
encTable = Encoding.GetEncoding(857);
break;
case 20:
encTable = Encoding.GetEncoding(860);
break;
case 21:
encTable = Encoding.GetEncoding(861);
break;
case 22:
encTable = Encoding.GetEncoding(863);
break;
case 23:
encTable = Encoding.GetEncoding(865);
break;
case 24:
encTable = Encoding.GetEncoding(866);
break;
case 25:
encTable = Encoding.GetEncoding(869);
break;
default:
break;
result.Add(GlobalNames.UnknowData, 1);
return;
}
Decoder dec = encTable.GetDecoder();
var messageLength = (channelData.Length - offset) / symbLength;
if (messageLength < 0)
{
return;
}
string message;
byte[] symbolsArray = new byte[messageLength];
int index = 0;
while (messageLength > 0)
{
symbolsArray[index++] = TetraUtils.BitsToByte(channelData.Ptr, offset, symbLength);
offset += symbLength;
messageLength--;
}
message = encTable.GetString(symbolsArray);
Debug.WriteLine(" data:" + message);
}
public static int ParseParams(LogicChannel channelData, int offset, Rules[] rules, ReceivedData result)
{
var skipRules = 0;
for (int i = 0; i < rules.Length; i++)
{
if (offset >= channelData.Length)
{
if (!result.Contains(GlobalNames.OutOfBuffer))
{
result.SetValue(GlobalNames.OutOfBuffer, 1);
}
return(offset);
}
if (skipRules > 0)
{
skipRules--;
continue;
}
var param = rules[i];
var value = TetraUtils.BitsToInt32(channelData.Ptr, offset, param.Length);
switch (param.Type)
{
case RulesType.Direct:
if (param.GlobalName != GlobalNames.Reserved)
{
result.SetValue(param.GlobalName, value);
}
offset += param.Length;
continue;
case RulesType.Options_bit:
offset += param.Length;
if (value == 0)
{
return(offset);
}
break;
case RulesType.Presence_bit:
if (value == 0)
{
skipRules = param.Ext1;
}
offset += param.Length;
break;
case RulesType.More_bit:
offset += param.Length;
return(offset);
case RulesType.Switch:
if (result.Value((GlobalNames)rules[i].Ext1) == rules[i].Ext2)
{
if (param.GlobalName != GlobalNames.Reserved)
{
result.SetValue(param.GlobalName, value);
}
offset += param.Length;
}
break;
case RulesType.SwitchNot:
if (result.Value((GlobalNames)rules[i].Ext1) != rules[i].Ext2)
{
if (param.GlobalName != GlobalNames.Reserved)
{
result.SetValue(param.GlobalName, value);
}
offset += param.Length;
}
break;
case RulesType.Jamp:
if (result.Value((GlobalNames)rules[i].Ext1) == rules[i].Ext2)
{
skipRules = param.Ext3;
}
break;
case RulesType.JampNot:
if (result.Value((GlobalNames)rules[i].Ext1) != rules[i].Ext2)
{
skipRules = param.Ext3;
}
break;
case RulesType.Reserved:
{
offset += param.Length;
}
break;
}
}
return(offset);
}
public void TmoParseMacPDU(LogicChannel channelData, List <ReceivedData> result)
{
var nullPduLength = 16; // only for receive pi/4 modulation ;
var blockOffset = 0;
var nullPdu = false;
var pduEnd = false;
for (int i = 0; i < 5; i++)
{
var offset = blockOffset;
var pdu = new ReceivedData();
pdu.Add(GlobalNames.CurrTimeSlot, channelData.TimeSlot);
var resourceType = (MAC_PDU_Type)TetraUtils.BitsToInt32(channelData.Ptr, offset, 2);
offset += 2;
pdu.Add(GlobalNames.MAC_PDU_Type, (int)resourceType);
switch (resourceType)
{
case MAC_PDU_Type.Broadcast:
blockOffset = SysInfoPDU(channelData, offset, pdu);
break;
case MAC_PDU_Type.MAC_resource:
ResourcePDU(channelData, offset, pdu);
blockOffset += (pdu.Value(GlobalNames.Length_indication) * 8);
break;
case MAC_PDU_Type.MAC_U_Signal:
if (channelData.Length == 124)
{
UsignalPDU(channelData, offset, pdu);
pduEnd = true;
}
else
{
Debug.Write(" MAC-D-BLCK_PDU");
pduEnd = true;
}
break;
case MAC_PDU_Type.MAC_frag:
var isTheEnd = TetraUtils.BitsToInt32(channelData.Ptr, offset, 1);
offset++;
if (isTheEnd == 0)
{
MacFraqPDU(channelData, offset, pdu);
pduEnd = true;
}
else
{
MacEndPDU(channelData, offset, pdu);
blockOffset += (pdu.Value(GlobalNames.Length_indication) * 8);
}
break;
}
nullPdu = pdu.Contains(GlobalNames.Null_pdu) || pdu.Contains(GlobalNames.OutOfBuffer);
if (nullPdu)
{
pduEnd = true;
}
//if (pdu.ContainsKey(GlobalNames.UnknowData)) nullPdu = true;
if (!nullPdu)
{
result.Add(pdu);
}
if ((blockOffset >= (channelData.Length - nullPduLength)) || pduEnd)
{
break;
}
}
}