/* * Copyright (C) 2010 DSD Author * GPG Key ID: 0x3F1D7FD0 (74EF 430D F7F2 0A48 FCE6 F630 FAA2 635D 3F1D 7FD0) * * Permission to use, copy, modify, and/or distribute this software for any * purpose with or without fee is hereby granted, provided that the above * copyright notice and this permission notice appear in all copies. * * THE SOFTWARE IS PROVIDED "AS IS" AND ISC DISCLAIMS ALL WARRANTIES WITH * REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY * AND FITNESS. IN NO EVENT SHALL ISC BE LIABLE FOR ANY SPECIAL, DIRECT, * INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM * LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE * OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR * PERFORMANCE OF THIS SOFTWARE. */ #include "dsd.h" #include "dpmr_const.h" /* Uncomment this define to display the dPMR debug info */ //#define dPMR_PRINT_DEBUG_INFO void processdPMRvoice (dsd_opts * opts, dsd_state * state) { // extracts AMBE frames from DMR frame uint32_t i, j, k, dibit; uint8_t CCH[NB_OF_DPMR_VOICE_FRAME_TO_DECODE][72] = {0}; uint8_t CCHDescrambled[NB_OF_DPMR_VOICE_FRAME_TO_DECODE][72] = {0}; uint8_t CCHDeInterleaved[NB_OF_DPMR_VOICE_FRAME_TO_DECODE][72] = {0}; uint8_t CCHDataHammingCorrected[NB_OF_DPMR_VOICE_FRAME_TO_DECODE][48] = {0}; uint8_t CCHDataCRC[NB_OF_DPMR_VOICE_FRAME_TO_DECODE] = {0}; uint8_t CCHDataCRCComputed[NB_OF_DPMR_VOICE_FRAME_TO_DECODE] = {0}; //uint8_t TCH[NB_OF_DPMR_VOICE_FRAME_TO_DECODE * 4][72] = {0}; uint8_t CC[NB_OF_DPMR_VOICE_FRAME_TO_DECODE / 2][24] = {0}; char ambe_fr[NB_OF_DPMR_VOICE_FRAME_TO_DECODE * 4][4][24] = {0}; char ambe_fr2[4][24]; const int *w, *x, *y, *z; uint32_t ScramblerLFSR = 0; bool correctable = true; bool HammingCorrectable[NB_OF_DPMR_VOICE_FRAME_TO_DECODE][6] = {0}; uint32_t CrcOk[NB_OF_DPMR_VOICE_FRAME_TO_DECODE] = {0}; uint32_t HammingOk[NB_OF_DPMR_VOICE_FRAME_TO_DECODE] = {0}; uint32_t Temp = 0; /* CCH (Control CHannel) data */ uint32_t CCH_FrameNumber[NB_OF_DPMR_VOICE_FRAME_TO_DECODE] = {0}; uint32_t CCH_CalledID = 0; uint32_t CCH_CallingID = 0; uint32_t CCH_CommunicationMode[NB_OF_DPMR_VOICE_FRAME_TO_DECODE] = {0}; uint32_t CCH_Version[NB_OF_DPMR_VOICE_FRAME_TO_DECODE]; uint32_t CCH_CommsFormat[NB_OF_DPMR_VOICE_FRAME_TO_DECODE]; uint32_t CCH_EmergencyPriority[NB_OF_DPMR_VOICE_FRAME_TO_DECODE]; uint32_t CCH_Reserved[NB_OF_DPMR_VOICE_FRAME_TO_DECODE]; uint32_t CCH_SlowData[NB_OF_DPMR_VOICE_FRAME_TO_DECODE]; uint32_t *errs; uint32_t *errs2; uint8_t AmbeBitDescrambled[49] = {0}; uint32_t ScramblerKey = 0; uint32_t PartOfSuperFrame = 0; uint32_t VoiceFrameFlag = 1; /* We consider the current frame as a voice frame */ uint32_t AttachedDataFlag = 0; uint8_t CalledID[8] = {0}; uint8_t CallingID[8] = {0}; /* Remove compiler warning */ //UNUSED_VARIABLE(AmbeBitDescrambled[0]); //UNUSED_VARIABLE(ScramblerKey); //UNUSED_VARIABLE(PartOfSuperFrame); if (opts->errorbars == 1) { //fprintf(stderr, "VOICE e:"); } /* First CCH (Control CHannel) - 72 bit */ k = 0; for (i = 0; i < 36; i++) { dibit = getDibit (opts, state); if (opts->inverted_dpmr == 1) { dibit = (dibit ^ 2); } CCH[0][(i * 2)] = (1 & (dibit >> 1)); // bit 1 CCH[0][(i * 2) + 1] = (1 & dibit); // bit 0 #ifdef DPMR_DUMP fprintf(stderr, "%c", dibit + 48); #endif } #ifdef DPMR_DUMP fprintf(stderr, " "); #endif /* 4 TCH (Traffic CHannel) = 4 x 72 bit voice playload */ k = 0; for (j = 0; j < 4; j++) { w = dPmrW; x = dPmrX; y = dPmrY; z = dPmrZ; k = 0; for (i = 0; i < 36; i++) { dibit = getDibit (opts, state); if (opts->inverted_dpmr == 1) { dibit = (dibit ^ 2); } #ifdef DPMR_DUMP fprintf(stderr, "%c", dibit + 48); #endif ambe_fr[j][*w][*x] = (1 & (dibit >> 1)); // bit 1 ambe_fr[j][*y][*z] = (1 & dibit); // bit 0 ambe_fr2[*w][*x] = (1 & (dibit >> 1)); // bit 1 ambe_fr2[*y][*z] = (1 & dibit); // bit 0 //TCH[j][k] = (1 & (dibit >> 1)); // bit 1 //TCH[j][k + 1] = (1 & dibit); // bit 0 state->dPMRVoiceFS2Frame.RawVoiceBit[j][k] = (1 & (dibit >> 1)); // bit 1 state->dPMRVoiceFS2Frame.RawVoiceBit[j][k + 1] = (1 & dibit); // bit 0 k = k + 2; w++; x++; y++; z++; } //processMbeFrame (opts, state, NULL, ambe_fr[j], NULL); //HERE HERE #ifdef DPMR_DUMP fprintf(stderr, " "); #endif } //processMbeFrame (opts, state, NULL, ambe_fr[0], NULL); //HERE HERE //processMbeFrame (opts, state, NULL, ambe_fr[1], NULL); //HERE HERE //processMbeFrame (opts, state, NULL, ambe_fr[2], NULL); //HERE HERE //processMbeFrame (opts, state, NULL, ambe_fr[3], NULL); //HERE HERE /* First CC (Channel Code) - 24 bit */ k = 0; for (i = 0; i < 12; i++) { dibit = getDibit (opts, state); if (opts->inverted_dpmr == 1) { dibit = (dibit ^ 2); } CC[0][k++] = (1 & (dibit >> 1)); // bit 1 CC[0][k++] = (1 & dibit); // bit 0 #ifdef DPMR_DUMP fprintf(stderr, "%c", dibit + 48); #endif } #ifdef DPMR_DUMP fprintf(stderr, " "); #endif /* Get the color code */ state->dPMRVoiceFS2Frame.ColorCode[0] = (unsigned int)GetdPmrColorCode(CC[0]); /* Second CCH (Control CHannel) - 72 bit */ k = 0; for (i = 0; i < 36; i++) { dibit = getDibit (opts, state); if (opts->inverted_dpmr == 1) { dibit = (dibit ^ 2); } CCH[1][k++] = (1 & (dibit >> 1)); // bit 1 CCH[1][k++] = (1 & dibit); // bit 0 #ifdef DPMR_DUMP fprintf(stderr, "%c", dibit + 48); #endif } #ifdef DPMR_DUMP fprintf(stderr, " "); #endif /* 4 TCH (Traffic CHannel) = 4 x 72 bit voice playload */ k = 0; for (j = 0; j < 4; j++) { w = dPmrW; x = dPmrX; y = dPmrY; z = dPmrZ; k = 0; for (i = 0; i < 36; i++) { dibit = getDibit (opts, state); if (opts->inverted_dpmr == 1) { dibit = (dibit ^ 2); } #ifdef DPMR_DUMP fprintf(stderr, "%c", dibit + 48); #endif ambe_fr[j + 4][*w][*x] = (1 & (dibit >> 1)); // bit 1 ambe_fr[j + 4][*y][*z] = (1 & dibit); // bit 0 //ambe_fr2[*w][*x] = (1 & (dibit >> 1)); // bit 1 //ambe_fr2[*y][*z] = (1 & dibit); // bit 0 //TCH[j + 4][k] = (1 & (dibit >> 1)); // bit 1 //TCH[j + 4][k + 1] = (1 & dibit); // bit 0 state->dPMRVoiceFS2Frame.RawVoiceBit[j + 4][k] = (1 & (dibit >> 1)); // bit 1 state->dPMRVoiceFS2Frame.RawVoiceBit[j + 4][k + 1] = (1 & dibit); // bit 0 k = k + 2; w++; x++; y++; z++; } //processMbeFrame (opts, state, NULL, ambe_fr[j], NULL); #ifdef DPMR_DUMP fprintf(stderr, " "); #endif } //processMbeFrame (opts, state, NULL, ambe_fr[4], NULL); //HERE HERE //processMbeFrame (opts, state, NULL, ambe_fr[5], NULL); //HERE HERE //processMbeFrame (opts, state, NULL, ambe_fr[6], NULL); //HERE HERE //processMbeFrame (opts, state, NULL, ambe_fr[7], NULL); //HERE HERE #ifdef dPMR_PRINT_DEBUG_INFO fprintf(stderr, "\n"); #endif /* dPMR_PRINT_DEBUG_INFO */ /* Initialize the Hamming (12,8) error code detection * Not needed because it has already been done * in the "InitAllFecFunction()" function */ //Hamming_12_8_init(); /* Decoding all CCH (Control CHannel) */ for(i = 0; i < NB_OF_DPMR_VOICE_FRAME_TO_DECODE; i++) { /* Init LFSR value - All bit to '1' */ ScramblerLFSR = 0x1FF; /* Descramble data - Input 72 bit => Output 72 bit */ ScrambledPMRBit(&ScramblerLFSR, CCH[i], CCHDescrambled[i], 72); /* Deinterleave data - Input 72 bit => Output 72 bit */ DeInterleave6x12DPmrBit(CCHDescrambled[i], CCHDeInterleaved[i]); correctable = true; for(j = 0; j < 6; j++) { /* Apply the Hamming(12,8) correction - Input 72 bit => Output 48 bit */ HammingCorrectable[i][j] = Hamming_12_8_decode(&CCHDeInterleaved[i][j*12], &CCHDataHammingCorrected[i][j*8], 1); if(HammingCorrectable[i][j] == false) correctable = false; } if(correctable) { #ifdef dPMR_PRINT_DEBUG_INFO fprintf(stderr, "CCH data corrected successfully\n"); #endif /* dPMR_PRINT_DEBUG_INFO */ HammingOk[i] = 1; } else { #ifdef dPMR_PRINT_DEBUG_INFO fprintf(stderr, "ERROR !!! CCH data contains uncorrectable bit\n"); #endif /* dPMR_PRINT_DEBUG_INFO */ HammingOk[i] = 0; } /* Reconstitute the 7 bit CRC */ CCHDataCRC[i] = 0; CCHDataCRC[i] |= (CCHDataHammingCorrected[i][41]) << 6; CCHDataCRC[i] |= (CCHDataHammingCorrected[i][42]) << 5; CCHDataCRC[i] |= (CCHDataHammingCorrected[i][43]) << 4; CCHDataCRC[i] |= (CCHDataHammingCorrected[i][44]) << 3; CCHDataCRC[i] |= (CCHDataHammingCorrected[i][45]) << 2; CCHDataCRC[i] |= (CCHDataHammingCorrected[i][46]) << 1; CCHDataCRC[i] |= (CCHDataHammingCorrected[i][47]) << 0; /* Compute the 7 bit CRC */ CCHDataCRCComputed[i] = CRC7BitdPMR(CCHDataHammingCorrected[i], 41); if(CCHDataCRC[i] == CCHDataCRCComputed[i]) { #ifdef dPMR_PRINT_DEBUG_INFO fprintf(stderr, "Good CCH CRCs ! CRC received = 0x%02X, CRC computed = 0x%02X\n", CCHDataCRC[i], CCHDataCRCComputed[i]); #endif /* dPMR_PRINT_DEBUG_INFO */ CrcOk[i] = 1; } else { #ifdef dPMR_PRINT_DEBUG_INFO fprintf(stderr, "ERROR !!! CCH CRCs are different ! CRC received = 0x%02X, CRC computed = 0x%02X\n", CCHDataCRC[i], CCHDataCRCComputed[i]); #endif /* dPMR_PRINT_DEBUG_INFO */ CrcOk[i] = 0; } /* Fill the frame number */ CCH_FrameNumber[i] = ConvertBitIntoBytes(&CCHDataHammingCorrected[i][0], 2); /* Fill the communication mode */ CCH_CommunicationMode[i] = ConvertBitIntoBytes(&CCHDataHammingCorrected[i][14], 3); /* Fill the version */ CCH_Version[i] = ConvertBitIntoBytes(&CCHDataHammingCorrected[i][17], 2); /* Fill the comm format */ CCH_CommsFormat[i] = ConvertBitIntoBytes(&CCHDataHammingCorrected[i][19], 2); /* Fill the emergency priority bit */ CCH_EmergencyPriority[i] = (uint32_t)CCHDataHammingCorrected[i][21]; /* Fill the reserved bit */ CCH_Reserved[i] = (uint32_t)CCHDataHammingCorrected[i][22]; /* Fill the slow data */ CCH_SlowData[i] = ConvertBitIntoBytes(&CCHDataHammingCorrected[i][23], 18); /* Copy the CCH data into the structure */ memcpy(state->dPMRVoiceFS2Frame.CCHData[i], CCHDataHammingCorrected[i], 48); state->dPMRVoiceFS2Frame.CCHDataHammingOk[i] = HammingOk[i]; state->dPMRVoiceFS2Frame.CCHDataCRC[i] = CCHDataCRC[i]; state->dPMRVoiceFS2Frame.CCHDataCrcOk[i] = CrcOk[i]; state->dPMRVoiceFS2Frame.FrameNumbering[i] = CCH_FrameNumber[i]; state->dPMRVoiceFS2Frame.CommunicationMode[i] = CCH_CommunicationMode[i]; state->dPMRVoiceFS2Frame.Version[i] = CCH_Version[i]; state->dPMRVoiceFS2Frame.CommsFormat[i] = CCH_CommsFormat[i]; state->dPMRVoiceFS2Frame.EmergencyPriority[i] = CCH_EmergencyPriority[i]; state->dPMRVoiceFS2Frame.Reserved[i] = CCH_Reserved[i]; state->dPMRVoiceFS2Frame.SlowData[i] = CCH_SlowData[i]; } /* End for(i = 0; i < NB_OF_DPMR_VOICE_FRAME_TO_DECODE; i++) */ /* Get the last TG */ strcpy((char *)CalledID, (char *)state->dPMRVoiceFS2Frame.CalledID); CalledID[7] = '\0'; /* Get the last source ID */ strcpy((char *)CallingID, (char *)state->dPMRVoiceFS2Frame.CallingID); CallingID[7] = '\0'; #ifdef dPMR_PRINT_DEBUG_INFO /* Print Hamming debug info */ fprintf(stderr, " | "); for(i = 0; i < NB_OF_DPMR_VOICE_FRAME_TO_DECODE; i++) { fprintf(stderr, "Hamming[%u]=", i); for(j = 0; j < 6; j++) { if(HammingCorrectable[i][j]) fprintf(stderr, "1"); else fprintf(stderr, "0"); } fprintf(stderr, " HammingOk[%u]=%u", i, HammingOk[i]); fprintf(stderr, " CrcOk[%u]=%u", i, CrcOk[i]); //fprintf(stderr, " Bit[%u]=", i); //for(j = 0; j < 7; j++) //{ // if(CCHDataHammingCorrected[i][j + 41]) fprintf(stderr, "1"); // else fprintf(stderr, "0"); //} fprintf(stderr, " CRCrec=0x%02X CRCcomp=0x%02X", CCHDataCRC[i], CCHDataCRCComputed[i]); if(i < (NB_OF_DPMR_VOICE_FRAME_TO_DECODE - 1)) fprintf(stderr, " - "); } #endif /* dPMR_PRINT_DEBUG_INFO */ #if (NB_OF_DPMR_VOICE_FRAME_TO_DECODE == 2) /* To determine the part of the payload frame, we need to check the * Hamming code result, the CRC and the frame number */ // if( (HammingOk[0] && CrcOk[0] && (CCH_FrameNumber[0] == 0)) || // (HammingOk[1] && CrcOk[1] && (CCH_FrameNumber[1] == 1))) if(((CrcOk[0] || HammingCorrectable[0][0]) && (CCH_FrameNumber[0] == 0)) || ((CrcOk[1] || HammingCorrectable[1][0]) && (CCH_FrameNumber[1] == 1))) { /* First part of the super frame */ PartOfSuperFrame = 1; #ifdef dPMR_PRINT_DEBUG_INFO fprintf(stderr, "First part of the Super Frame\n"); #endif /* dPMR_PRINT_DEBUG_INFO */ /* The next part will normally be the second part */ opts->dPMR_next_part_of_superframe = 2; /* Fill the called ID (talk group - TG) */ Temp = ConvertBitIntoBytes(&CCHDataHammingCorrected[0][2], 12); CCH_CalledID = ((Temp << 12) & 0x00FFF000); /* 12 MSBit */ Temp = ConvertBitIntoBytes(&CCHDataHammingCorrected[1][2], 12); CCH_CalledID |= (Temp & 0x00000FFF); /* 12 LSBit */ ConvertAirInterfaceID(CCH_CalledID, CalledID); CalledID[7] = '\0'; /* Determine if the called TG ID only is correct */ //if(HammingOk[0] && CrcOk[0] && HammingOk[1] && CrcOk[1]) if((CrcOk[0] || (HammingCorrectable[0][0] && HammingCorrectable[0][1])) && (CrcOk[1] || (HammingCorrectable[1][0] && HammingCorrectable[1][1]))) { /* Save CCH data parameters */ state->dPMRVoiceFS2Frame.CalledIDOk = 1; } else { state->dPMRVoiceFS2Frame.CalledIDOk = 0; } /* BUGFIX : Copy in all case the TG ID */ strcpy((char *)state->dPMRVoiceFS2Frame.CalledID, (char *)CalledID); } /* To determine the part of the payload frame, we need to check the * Hamming code result, the CRC and the frame number */ // else if( (HammingOk[0] && CrcOk[0] && (CCH_FrameNumber[0] == 2)) || // (HammingOk[1] && CrcOk[1] && (CCH_FrameNumber[1] == 3))) else if(((CrcOk[0] || HammingCorrectable[0][0]) && (CCH_FrameNumber[0] == 2)) || ((CrcOk[1] || HammingCorrectable[1][0]) && (CCH_FrameNumber[1] == 3))) { /* Second part of the super frame */ PartOfSuperFrame = 2; #ifdef dPMR_PRINT_DEBUG_INFO fprintf(stderr, "Second part of the Super Frame\n"); #endif /* dPMR_PRINT_DEBUG_INFO */ /* The next part will normally be the first part */ opts->dPMR_next_part_of_superframe = 1; /* Fill the calling ID (source) */ Temp = ConvertBitIntoBytes(&CCHDataHammingCorrected[0][2], 12); CCH_CallingID = ((Temp << 12) & 0x00FFF000); /* 12 MSBit */ Temp = ConvertBitIntoBytes(&CCHDataHammingCorrected[1][2], 12); CCH_CallingID |= (Temp & 0x00000FFF); /* 12 LSBit */ ConvertAirInterfaceID(CCH_CallingID, CallingID); CallingID[7] = '\0'; /* Determine if the calling SRC ID is correct */ //if(HammingOk[0] && CrcOk[0] && HammingOk[1] && CrcOk[1]) if((CrcOk[0] || (HammingCorrectable[0][0] && HammingCorrectable[0][1])) && (CrcOk[1] || (HammingCorrectable[1][0] && HammingCorrectable[1][1]))) { /* Save CCH data parameters */ state->dPMRVoiceFS2Frame.CallingIDOk = 1; } else { state->dPMRVoiceFS2Frame.CallingIDOk = 0; } /* BUGFIX : Copy in all case the SRC ID */ strcpy((char *)state->dPMRVoiceFS2Frame.CallingID, (char *)CallingID); } else { /* The dPMR source and destination ID are now invalid */ state->dPMRVoiceFS2Frame.CalledIDOk = 0; state->dPMRVoiceFS2Frame.CallingIDOk = 0; /* Unknown part of superframe => We suppose * it is the next part of the previous frame received */ PartOfSuperFrame = opts->dPMR_next_part_of_superframe; /* Set the next part of the superframe to receive */ if(opts->dPMR_next_part_of_superframe == 1) { #ifdef dPMR_PRINT_DEBUG_INFO fprintf(stderr, "Supposed first part of the Super Frame\n"); #endif /* dPMR_PRINT_DEBUG_INFO */ /* Set the next part as the second part */ opts->dPMR_next_part_of_superframe = 2; } else if(opts->dPMR_next_part_of_superframe == 2) { #ifdef dPMR_PRINT_DEBUG_INFO fprintf(stderr, "Supposed second part of the Super Frame\n"); #endif /* dPMR_PRINT_DEBUG_INFO */ /* Set the next part as the first part */ opts->dPMR_next_part_of_superframe = 1; } else { #ifdef dPMR_PRINT_DEBUG_INFO fprintf(stderr, "Unknown part of the Super Frame\n"); #endif /* dPMR_PRINT_DEBUG_INFO */ /* Unknown current part, set to 0 */ opts->dPMR_next_part_of_superframe = 0; } } if(state->dPMRVoiceFS2Frame.ColorCode[0] != (unsigned int)(-1)) { /* Display the color code */ //fprintf(stderr, " | Color Code=%02d ", (int)state->dPMRVoiceFS2Frame.ColorCode[0]); } else { /* Unknown color code, display "??" */ //fprintf(stderr, " | Color Code=?? "); } /* Display the destination ID (talk group - TG) */ //fprintf(stderr, "| TG=%s", CalledID); if(state->dPMRVoiceFS2Frame.CalledIDOk) { fprintf(stderr, "\n| TG=%s", CalledID); //strcpy (state->dpmr_target_id, CalledID); //HERE HERE state->dpmr_target_id = CalledID; //fprintf(stderr, " (CRC OK) "); if(state->dPMRVoiceFS2Frame.ColorCode[0] != (unsigned int)(-1)) { fprintf(stderr, " | Color Code=%02d ", (int)state->dPMRVoiceFS2Frame.ColorCode[0]); state->dpmr_color_code = (int)state->dPMRVoiceFS2Frame.ColorCode[0]; } } else { //fprintf(stderr, " (CRC ERR) "); } /* Display the source ID */ //fprintf(stderr, "| Src=%s", CallingID); if(state->dPMRVoiceFS2Frame.CallingIDOk) { fprintf(stderr, "| Src=%s", CallingID); //strcpy (state->dpmr_caller_id, CallingID); state->dpmr_caller_id = CallingID; //fprintf(stderr, " (CRC OK) "); } else { fprintf(stderr, " (CRC ERR) "); } #endif /* (NB_OF_DPMR_VOICE_FRAME_TO_DECODE == 2) */ /* Test if the current frame is encrypted or not */ for(i = 0; i < NB_OF_DPMR_VOICE_FRAME_TO_DECODE; i++) { //if(HammingOk[i] && CrcOk[i]) if(HammingCorrectable[i][2] && CrcOk[i]) { /* Unencrypted voice frame => Version = 0 (0b00) */ if(state->dPMRVoiceFS2Frame.Version[i] == 0x00) { opts->dPMR_curr_frame_is_encrypted = 0; } /* Encrypted voice frame => Version = 3 (0b11) */ else if(state->dPMRVoiceFS2Frame.Version[i] == 0x03) { opts->dPMR_curr_frame_is_encrypted = 1; } else { /* Unknown clear or encrypted voice frame status */ } /* Valid encryption parameter found, * exit the "for" loop */ break; } /* End if(HammingCorrectable[i][2] && CrcOk[i]) */ } if(opts->dPMR_curr_frame_is_encrypted) fprintf(stderr, "| Scrambler "); /* Determine if the received frame is a voice frame, a voice frame + data * or a data frame. * * See ETSI TS 102 658 chapter 5.0.5 "Communication Mode [BT]" * for details */ VoiceFrameFlag = 0; AttachedDataFlag = 0; for(i = 0; i < NB_OF_DPMR_VOICE_FRAME_TO_DECODE; i++) { /* Search for voice frame * Note : Due to error decoding, we parse all CCH * Communication Mode parameters, if a voice parameter is * found, the entire payload is considered as voice */ if((state->dPMRVoiceFS2Frame.CommunicationMode[i] == 0) || (state->dPMRVoiceFS2Frame.CommunicationMode[i] == 1) || (state->dPMRVoiceFS2Frame.CommunicationMode[i] == 5)) { /* Voice frame detected */ VoiceFrameFlag = 1; /* Check if the voice frame contains attached data */ if((state->dPMRVoiceFS2Frame.CommunicationMode[i] == 5) && state->dPMRVoiceFS2Frame.CCHDataCrcOk[i]) { AttachedDataFlag = 1; } } } if(VoiceFrameFlag) { if(AttachedDataFlag) fprintf(stderr, "| Voice+Data "); else fprintf(stderr, "| Voice "); } else { fprintf(stderr, "| Data "); } /* Demodulate and store AMBE sample only if the current superframe * is a voice frame */ if(VoiceFrameFlag) { /* There is 4 AMBE voice sample per voice frame (= 8 per superframe) */ for(i = 0; i < (NB_OF_DPMR_VOICE_FRAME_TO_DECODE * 4); i++) //for(i = 0; i < (8); i++) { /* Apply ECC 1 to the AMBE frames */ state->dPMRVoiceFS2Frame.errs1[i] = (unsigned int)mbe_eccAmbe3600x2450C0(ambe_fr[i]); state->dPMRVoiceFS2Frame.errs2[i] = state->dPMRVoiceFS2Frame.errs1[i]; /* Demodulate the AMBE frames */ //mbe_demodulateAmbe3600x2450Data(ambe_fr[i]); mbe_demodulateAmbe3600x2400Data(ambe_fr[i]); /* Apply ECC 2 to the AMBE frames and get the 49 bit of the voice sample */ //state->dPMRVoiceFS2Frame.errs2[i] += (unsigned int)mbe_eccAmbe3600x2450Data(ambe_fr[i], (char *)state->dPMRVoiceFS2Frame.AmbeBit[i]); state->dPMRVoiceFS2Frame.errs2[i] += (unsigned int)mbe_eccAmbe3600x2400Data(ambe_fr[i], (char *)state->dPMRVoiceFS2Frame.AmbeBit[i]); //processMbeFrame (opts, state, NULL, ambe_fr[i], NULL); //HERE HERE //processMbeFrame (opts, state, NULL, state->dPMRVoiceFS2Frame.AmbeBit[i], NULL); //HERE HERE } } /* End if(VoiceFrameFlag && !AttachedDataFlag) */ //Check if the voice frame to play is encrypted if(opts->dPMR_curr_frame_is_encrypted) { //Encryption is not supported in the public version ScramblerKey = 0; } else { //The frame is unencrypted, //so set the scrambler key to 0 ScramblerKey = 0; } //Play only voice frame if(VoiceFrameFlag) { #ifdef dPMR_PRINT_DEBUG_INFO fprintf(stderr, "Voice frame to play\n"); #endif //dPMR_PRINT_DEBUG_INFO //There is 4 AMBE voice sample per voice frame (so 2 x 4 = 8 per superframe) for(i = 0; i < (NB_OF_DPMR_VOICE_FRAME_TO_DECODE * 4); i++) //is this backwards, shouldn't we run this first, and then voice frame after? { //errs = (uint32_t*)&(state->dPMRVoiceFS2Frame.errs1[i]); errs2 = (uint32_t*)&(state->dPMRVoiceFS2Frame.errs2[i]); errs = 0; //errs2 = 0; state->errs = state->dPMRVoiceFS2Frame.errs1[i]; state->errs2 = state->dPMRVoiceFS2Frame.errs2[i]; //sounds like choppy shit, but .amb file playback is acceptable, so investigate why this doesn't work properly //could be related to err states not properly done or something? mbe_processAmbe2450Dataf (state->audio_out_temp_buf, (int *)errs, (int *)errs2, state->err_str, (char *)state->dPMRVoiceFS2Frame.AmbeBit[i], state->cur_mp, state->prev_mp, state->prev_mp_enhanced, opts->uvquality); if (opts->mbe_out_f != NULL) { saveAmbe2450Data (opts, state, (char *)state->dPMRVoiceFS2Frame.AmbeBit[i]); } if (opts->errorbars == 1) { //fprintf(stderr, "%s", state->err_str); } //state->debug_audio_errors += *errs2; processAudio(opts, state); if (opts->wav_out_f != NULL) { writeSynthesizedVoice (opts, state); } if (opts->audio_out == 1) { //Play the AMBE Frames playSynthesizedVoice (opts, state); } } //End for(i = 0; i < (NB_OF_DPMR_VOICE_FRAME_TO_DECODE * 4); i++) } //End if(VoiceFrameFlag) else { #ifdef dPMR_PRINT_DEBUG_INFO fprintf(stderr, "Data frame, don't play it !\n"); #endif //dPMR_PRINT_DEBUG_INFO } if (opts->errorbars == 1) { fprintf(stderr, "\n"); } #ifdef dPMR_PRINT_DEBUG_INFO //Display the CCH content for(i = 0; i < NB_OF_DPMR_VOICE_FRAME_TO_DECODE; i++) { fprintf(stderr, "i = %u - ", i); fprintf(stderr, "Comm Mode = %01u - ", state->dPMRVoiceFS2Frame.CommunicationMode[i]); fprintf(stderr, "Version = %01u - ", state->dPMRVoiceFS2Frame.Version[i]); fprintf(stderr, "Comms Format = %01u - ", state->dPMRVoiceFS2Frame.CommsFormat[i]); fprintf(stderr, "Emergency = %01u - ", state->dPMRVoiceFS2Frame.EmergencyPriority[i]); fprintf(stderr, "Reserved = %01u - ", state->dPMRVoiceFS2Frame.Reserved[i]); fprintf(stderr, "Slow Data = 0x%05X - ", state->dPMRVoiceFS2Frame.SlowData[i]); if(HammingOk[i] && CrcOk[i]) fprintf(stderr, "Valid"); else fprintf(stderr, "CRC ERROR"); fprintf(stderr, "\n"); } #endif //dPMR_PRINT_DEBUG_INFO //Print sPMR frame (if needed) //dPMRVoiceFrameProcess(opts, state); //HERE HERE disabled to build } //End processdPMRvoice() /* Scrambler used for dPMR transmission (different of the * voice encryption scrambler), see ETSI TS 102 658 chapter * 7.3 for the polynomial description. * It is a X^9 + X^5 + 1 polynomial. */ void ScrambledPMRBit(uint32_t * LfsrValue, uint8_t * BufferIn, uint8_t * BufferOut, uint32_t NbOfBitToScramble) { uint8_t S[9] = {0}; uint32_t i; uint8_t Temp; uint32_t LFSRValue; LFSRValue = *LfsrValue; /* Load the initial LFSR value */ for(i = 0; i < 9; i++) { S[i] = LFSRValue & 1; LFSRValue >>= 1; } /* There are 72 bit to encrypt for voice and 288 bit for data */ for(i = 0; i < NbOfBitToScramble; i++) { BufferOut[i] = (BufferIn[i] ^ S[0]) & 0x01; /* Shift registers */ Temp = S[4] ^ S[0]; S[0] = S[1]; S[1] = S[2]; S[2] = S[3]; S[3] = S[4]; S[4] = S[5]; S[5] = S[6]; S[6] = S[7]; S[7] = S[8]; S[8] = Temp; } /* Save the final LFSR value */ LFSRValue = 0; for(i = 9; i > 0; i--) { LFSRValue <<= 1; LFSRValue |= S[i - 1] & 1; } *LfsrValue = LFSRValue; } /* End ScrambleDPmrBit() */ /* Scrambler used for dPMR encryption / decryption, * see ETSI TS 102 658 chapter 7.3 for the * polynomial description. * It is a X^9 + X^5 + 1 polynomial. */ void DeInterleave6x12DPmrBit(uint8_t * BufferIn, uint8_t * BufferOut) { uint8_t Matrix[12][6] = {0}; uint32_t i, j, k; /* Step 1 : Filling the 12 x 6 bit matrix */ k = 0; for(i = 0; i < 12; i++) { for(j = 0; j < 6; j++) { Matrix[i][j] = BufferIn[k++]; } } /* Step 2 : Filling the output buffer with deinterleaved data */ k = 0; for(j = 0; j < 6; j++) { for(i = 0; i < 12; i++) { BufferOut[k++] = Matrix[i][j]; } } } /* End DeInterleave6x12DPmrBit() */ /* CRC 7 bit computation with the following * polynomial : X^7 + X^3 + 1 */ uint8_t CRC7BitdPMR(uint8_t * BufferIn, uint32_t BitLength) { uint8_t ShiftRegister = 0x00; /* All bit to '0' (7 LSBit only used) */ uint8_t Polynome = 0x09; /* X^7 + X^3 + 1 */ uint32_t i; for(i = 0; i < BitLength; i++) { if(((ShiftRegister >> 6) & 1) ^ BufferIn[i]) { ShiftRegister = ((ShiftRegister << 1) ^ Polynome) & 0x7F; } else { ShiftRegister = (ShiftRegister << 1) & 0x7F; } } return ShiftRegister; } /* End CRC7BitdPMR() */ /* CRC 8 bit computation with the following * polynomial : X^8 + X^2 + X + 1 */ uint8_t CRC8BitdPMR(uint8_t * BufferIn, uint32_t BitLength) { uint8_t ShiftRegister = 0xFF; /* All bit to '1' */ uint8_t Polynome = 0x07; /* X^7 + X^3 + 1 */ uint32_t i; for(i = 0; i < BitLength; i++) { if(((ShiftRegister >> 7) & 1) ^ BufferIn[i]) { ShiftRegister = ((ShiftRegister << 1) ^ Polynome) & 0xFF; } else { ShiftRegister = (ShiftRegister << 1) & 0xFF; } } return ShiftRegister; } /* End CRC8BitdPMR() */ /* Convert an air interface identifier (AI ID) into * a 7 ASCII digit string. * * See dPMR standard chapter A.1.2.1.1.6 * "Mapping of dialled strings to the AI address space" */ void ConvertAirInterfaceID(uint32_t AI_ID, uint8_t ID[8]) { uint32_t AI_ID_Temp = AI_ID; uint32_t Digit; /* 1st digit */ Digit = AI_ID_Temp / 1464100; AI_ID_Temp = AI_ID_Temp % 1464100; if(Digit == 10) ID[0] = '*'; else ID[0] = Digit + '0'; /* 2nd digit */ Digit = AI_ID_Temp / 146410; AI_ID_Temp = AI_ID_Temp % 146410; if(Digit == 10) ID[1] = '*'; else ID[1] = Digit + '0'; /* 3rd digit */ Digit = AI_ID_Temp / 14641; AI_ID_Temp = AI_ID_Temp % 14641; if(Digit == 10) ID[2] = '*'; else ID[2] = Digit + '0'; /* 4th digit */ Digit = AI_ID_Temp / 1331; AI_ID_Temp = AI_ID_Temp % 1331; if(Digit == 10) ID[3] = '*'; else ID[3] = Digit + '0'; /* 5th digit */ Digit = AI_ID_Temp / 121; AI_ID_Temp = AI_ID_Temp % 121; if(Digit == 10) ID[4] = '*'; else ID[4] = Digit + '0'; /* 6th digit */ Digit = AI_ID_Temp / 11; AI_ID_Temp = AI_ID_Temp % 11; if(Digit == 10) ID[5] = '*'; else ID[5] = Digit + '0'; /* 7th digit */ Digit = AI_ID_Temp; if(Digit == 10) ID[6] = '*'; else ID[6] = Digit + '0'; /* Add the "end of string" */ ID[7] = '\0'; } /* End convertAirInterfaceID() */ /* End of file */