/* * (C) 2013 by Andreas Eversberg * (C) 2015 by Alexander Chemeris * * All Rights Reserved * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License along * with this program; if not, write to the Free Software Foundation, Inc., * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. */ #include #include #include #include #include #include #include #include #define DUMP_U_AT(b, x, u) do { \ printf("%s %02x %02x ", osmo_ubit_dump(b + x, 57), b[57 + x], b[58 + x]); \ printf("%s\n", osmo_ubit_dump(b + 59 + x, 57)); \ if (u <= x) \ return; \ } while(0) #define DUMP_S_AT(b, x, u) do { \ printf("%s %02x %02x ", osmo_hexdump(b + x, 57), b[57 + x], b[58 + x]); \ printf("%s\n", osmo_hexdump(b + 59 + x, 57)); \ if (u <= x) \ return; \ } while(0) /* Similar to OSMO_ASSERT, but does not panic() */ #define CHECK_RC_OR_RET(exp, action) \ if (!(exp)) { \ printf("%s(%s): assert %s failed\n", __func__, action, #exp); \ return; \ } #ifdef DEBUG #define printd(fmt, args...) printf(fmt, ##args) #else #define printd(fmt, args...) #endif static inline void dump_ubits(ubit_t *bursts_u, unsigned until) { printf("U-Bits:\n"); DUMP_U_AT(bursts_u, 0, until); DUMP_U_AT(bursts_u, 116, until); DUMP_U_AT(bursts_u, 232, until); DUMP_U_AT(bursts_u, 348, until); DUMP_U_AT(bursts_u, 464, until); DUMP_U_AT(bursts_u, 580, until); DUMP_U_AT(bursts_u, 696, until); DUMP_U_AT(bursts_u, 812, until); } static inline void dump_sbits(uint8_t *bursts_s, unsigned until) { printf("S-Bits:\n"); DUMP_S_AT(bursts_s, 0, until); DUMP_S_AT(bursts_s, 116, until); DUMP_S_AT(bursts_s, 232, until); DUMP_S_AT(bursts_s, 348, until); DUMP_S_AT(bursts_s, 464, until); DUMP_S_AT(bursts_s, 580, until); DUMP_S_AT(bursts_s, 696, until); DUMP_S_AT(bursts_s, 812, until); } static void test_xcch(uint8_t *l2) { uint8_t result[23]; ubit_t bursts_u[116 * 4]; sbit_t bursts_s[116 * 4]; int n_errors, n_bits_total; int rc; /* Encode L2 message */ printf("Encoding: %s\n", osmo_hexdump(l2, 23)); rc = gsm0503_xcch_encode(bursts_u, l2); CHECK_RC_OR_RET(rc == 0, "encoding"); /* Prepare soft-bits */ osmo_ubit2sbit(bursts_s, bursts_u, 116 * 4); dump_ubits(bursts_u, 348); dump_sbits((uint8_t *)bursts_s, 348); /* Destroy some bits */ memset(bursts_s, 0, 30); memset(bursts_s + 116, 0, 30); /* Decode, correcting errors */ rc = gsm0503_xcch_decode(result, bursts_s, &n_errors, &n_bits_total); CHECK_RC_OR_RET(rc == 0, "decoding"); printf("Decoded: %s\n", osmo_hexdump(result, 23)); printf("xcch_decode: n_errors=%d n_bits_total=%d ber=%.2f\n", n_errors, n_bits_total, (float) n_errors / n_bits_total); OSMO_ASSERT(n_bits_total == 456); OSMO_ASSERT(!memcmp(l2, result, 23)); printf("\n"); } static void test_rach(uint8_t bsic, uint8_t ra) { int rc; uint8_t result; ubit_t bursts_u[36]; sbit_t bursts_s[36]; /* Encode L2 message */ printd("Encoding: %02x\n", ra); rc = gsm0503_rach_ext_encode(bursts_u, ra, bsic, false); CHECK_RC_OR_RET(rc == 0, "encoding"); /* Prepare soft-bits */ osmo_ubit2sbit(bursts_s, bursts_u, 36); printd("U-Bits: %s\n", osmo_ubit_dump(bursts_u, 36)); printd("S-Bits: %s\n", osmo_hexdump((uint8_t *)bursts_s, 36)); /* Destroy some bits */ memset(bursts_s + 6, 0, 8); /* Decode, correcting errors */ rc = gsm0503_rach_decode_ber(&result, bursts_s, bsic, NULL, NULL); CHECK_RC_OR_RET(rc == 0, "decoding"); printd("Decoded: %02x\n", result); if (ra != result) printf("FAIL [RACH]: encoded %u != %u decoded\n", ra, result); printd("\n"); } static void test_rach_ext(uint8_t bsic, uint16_t ra) { int rc; uint16_t result = 3000; /* Max ext. RA is 2^11 = 2048 */ ubit_t bursts_u[36]; sbit_t bursts_s[36]; /* Encode L2 message */ printd("Encoding: %02x\n", ra); rc = gsm0503_rach_ext_encode(bursts_u, ra, bsic, true); CHECK_RC_OR_RET(rc == 0, "encoding"); /* Prepare soft-bits */ osmo_ubit2sbit(bursts_s, bursts_u, 36); printd("U-Bits: %s\n", osmo_ubit_dump(bursts_u, 36)); printd("S-Bits: %s\n", osmo_hexdump((uint8_t *)bursts_s, 36)); /* Destroy some bits */ memset(bursts_s + 9, 0, 8); /* Decode, correcting errors */ rc = gsm0503_rach_ext_decode_ber(&result, bursts_s, bsic, NULL, NULL); CHECK_RC_OR_RET(rc == 0, "decoding"); printd("Decoded: %02x\n", result); if (ra != result) printf("FAIL [RACH ext]: encoded %u != %u decoded\n", ra, result); printd("\n"); } static void test_rach_11bit_sample(uint8_t bsic, const sbit_t *payload) { int n_errors, n_bits_total; uint16_t ra11; int rc; /* Decode, correcting errors */ rc = gsm0503_rach_ext_decode_ber(&ra11, payload, bsic, &n_errors, &n_bits_total); if (rc) { printf("%s(): decoding failed (rc=%d)\n", __func__, rc); return; } printf("Decoded RA11: 0x%03x\n", ra11); } static void test_sch(uint8_t *info) { uint8_t result[4]; ubit_t bursts_u[78]; sbit_t bursts_s[78]; int rc; /* Zero bits 25 and above */ info[3] &= 1; result[3] = 0; /* Encode L2 message */ printf("Encoding: %s\n", osmo_hexdump(info, 4)); rc = gsm0503_sch_encode(bursts_u, info); CHECK_RC_OR_RET(rc == 0, "encoding"); /* Prepare soft-bits */ osmo_ubit2sbit(bursts_s, bursts_u, 78); printf("U-Bits: %s\n", osmo_ubit_dump(bursts_u, 78)); printf("S-Bits: %s\n", osmo_hexdump((uint8_t *)bursts_s, 78)); /* Destroy some bits */ memset(bursts_s + 6, 0, 10); /* Decode, correcting errors */ rc = gsm0503_sch_decode(result, bursts_s); CHECK_RC_OR_RET(rc == 0, "decoding"); printf("Decoded: %s\n", osmo_hexdump(result, 4)); OSMO_ASSERT(!memcmp(info, result, 4)); printf("\n"); } static void test_fr(uint8_t *speech, int len) { uint8_t result[33]; ubit_t bursts_u[116 * 8]; sbit_t bursts_s[116 * 8]; int n_errors, n_bits_total; int rc; memset(bursts_u, 0x23, sizeof(bursts_u)); memset(bursts_s, 0, sizeof(bursts_s)); /* Encode L2 message */ printf("Encoding: %s\n", osmo_hexdump(speech, len)); rc = gsm0503_tch_fr_encode(bursts_u, speech, len, 1); CHECK_RC_OR_RET(rc == 0, "encoding"); /* Prepare soft-bits */ osmo_ubit2sbit(bursts_s, bursts_u, 116 * 8); dump_ubits(bursts_u, 812); dump_sbits((uint8_t *)bursts_s, 812); /* Destroy some bits */ memset(bursts_s + 6, 0, 20); /* Decode, correcting errors */ rc = gsm0503_tch_fr_decode(result, bursts_s, 1, len == 31, &n_errors, &n_bits_total); CHECK_RC_OR_RET(rc == len, "decoding"); printf("Decoded: %s\n", osmo_hexdump(result, len)); printf("tch_fr_decode: n_errors=%d n_bits_total=%d ber=%.2f\n", n_errors, n_bits_total, (float)n_errors/n_bits_total); OSMO_ASSERT(!memcmp(speech, result, len)); printf("\n"); } static void test_hr(uint8_t *speech, int len) { uint8_t result[23]; ubit_t bursts_u[116 * 6]; sbit_t bursts_s[116 * 6]; int n_errors, n_bits_total; int rc; memset(bursts_u, 0x23, sizeof(bursts_u)); memset(bursts_s, 0, sizeof(bursts_s)); /* Encode L2 message */ printf("Encoding: %s\n", osmo_hexdump(speech, len)); rc = gsm0503_tch_hr_encode(bursts_u, speech, len); CHECK_RC_OR_RET(rc == 0, "encoding"); /* Prepare soft-bits */ osmo_ubit2sbit(bursts_s, bursts_u, 116 * 6); dump_ubits(bursts_u, 580); dump_sbits((uint8_t *)bursts_s, 580); /* Destroy some bits */ memset(bursts_s + 6, 0, 20); /* Decode, correcting errors */ rc = gsm0503_tch_hr_decode(result, bursts_s, 0, &n_errors, &n_bits_total); CHECK_RC_OR_RET(rc == len, "decoding"); printf("Decoded: %s\n", osmo_hexdump(result, len)); printf("tch_hr_decode: n_errors=%d n_bits_total=%d ber=%.2f\n", n_errors, n_bits_total, (float)n_errors/n_bits_total); OSMO_ASSERT(!memcmp(speech, result, len)); printf("\n"); } struct test_macblock { bool is_egprs; uint16_t exp_burst_bits; uint16_t l2_len; uint8_t l2[54]; }; static const struct test_macblock test_macblock[] = { /* Random frame */ { false, GSM0503_GPRS_BURSTS_NBITS, 54, { 0xa3, 0xaf, 0x5f, 0xc6, 0x36, 0x43, 0x44, 0xab, 0xd9, 0x6d, 0x7d, 0x62, 0x24, 0xc9, 0xd2, 0x92, 0xfa, 0x27, 0x5d, 0x71, 0x7a, 0x59, 0xa8, 0x42, 0xa3, 0xaf, 0x5f, 0xc6, 0x36, 0x43, 0x44, 0xab, 0xa3, 0xaf, 0x5f, 0xc6, 0x36, 0x43, 0x44, 0xab, 0xd9, 0x6d, 0x7d, 0x62, 0x24, 0xc9, 0xd2, 0x92, 0xfa, 0x27, 0x5d, 0x71, 0x7a, 0xa8 } }, /* jolly frame */ { false, GSM0503_GPRS_BURSTS_NBITS, 23, { 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17 } }, /* GSM RLC/MAC: EGPRS DL HEADER 0... .... .... 0000 = DL TFI: 0 0... .... crumb 1 of DL TFI (decoded above) .00. .... = RRBP: Reserved Block: (N+13) mod 2715648 (0) ...0 0... = ES/P: RRBP field is not valid (no Polling) (0) .... .111 = USF: 7 01.. .... 0000 0000 .... ...0 = BSN: 1 01.. .... crumb 2 of BSN (decoded above) ..00 .... = PR: 0 dB (included) to 3 dB (excluded) less than BCCH level - P0 (0) .... 0000 crumb 0 of DL TFI (decoded above) 0000 0000 crumb 1 of BSN (decoded above) .00. .... = SPB (DL): No retransmission (0) ...1 011. = CPS: MCS-1/P1 (0x0b) .... ...0 crumb 0 of BSN (decoded above) GSM RLC/MAC: EGPRS DL DATA BLOCK 1 (BSN 1) .... ..0. = FBI: Current Block is not last RLC data block in TBF .... ...0 = Extension: Extension octet follows immediately 0000 100. = Length Indicator: 4 .... ...0 = Extension: Extension octet follows immediately 0010 000. = Length Indicator: 16 .... ...1 = Extension: No extension octet follows data segment: LI[0]=4 indicates: (Last segment of) LLC frame (4 octets) Data (4 bytes) Data: 012b2b2b [Length: 4] data segment: LI[1]=16 indicates: (Last segment of) LLC frame (16 octets) Data (16 bytes) Data: 43c0012b2b2b2b2b2b2b2b2b2b2b2b2b [Length: 16] */ { true, GSM0503_GPRS_BURSTS_NBITS, 27, { 0x07, 0x40, 0x00, 0x16, 0x10, 0x42, 0x02, 0x56, 0x56, 0x56, 0x86, 0x80, 0x03, 0x56, 0x56, 0x56, 0x56, 0x56, 0x56, 0x56, 0x56, 0x56, 0x56, 0x56, 0x56, 0x56, 0x00 } }, }; static void test_pdtch(const struct test_macblock *tmb, int len) { uint8_t l2[len], result[len]; ubit_t bursts_u[116 * 4]; sbit_t bursts_s[116 * 4]; int n_errors, n_bits_total; int rc; /* Zero the not coded tail bits */ memcpy(l2, tmb->l2, len); switch (len) { case 34: case 54: l2[len - 1] &= 0x7f; result[len - 1] &= 0x7f; break; case 40: l2[len - 1] &= 0x07; result[len - 1] &= 0x07; break; } /* Encode L2 message */ printf("Encoding: %s\n", osmo_hexdump(l2, len)); if (tmb->is_egprs) rc = gsm0503_pdtch_egprs_encode(bursts_u, l2, len); else rc = gsm0503_pdtch_encode(bursts_u, l2, len); CHECK_RC_OR_RET(rc == (int)tmb->exp_burst_bits, "encoding"); /* Prepare soft-bits */ osmo_ubit2sbit(bursts_s, bursts_u, 116 * 4); dump_ubits(bursts_u, 348); dump_sbits((uint8_t *)bursts_s, 348); /* Decode */ if (tmb->is_egprs) { /* gsm0503_pdtch_egprs_decode() is meant to decode EGPRS UL frames, so we cannot use it here */ rc = gsm0503_pdtch_egprs_decode(result, bursts_s, rc, NULL, &n_errors, &n_bits_total); OSMO_ASSERT(rc == -EIO); return; } else { rc = gsm0503_pdtch_decode(result, bursts_s, NULL, &n_errors, &n_bits_total); } CHECK_RC_OR_RET(rc == len, "decoding"); printf("Decoded: %s\n", osmo_hexdump(result, len)); printf("pdtch_decode: n_errors=%d n_bits_total=%d ber=%.2f\n", n_errors, n_bits_total, (float)n_errors/n_bits_total); OSMO_ASSERT(!memcmp(l2, result, len)); printf("\n"); } uint8_t test_l2[][23] = { /* Dummy frame */ { 0x03, 0x03, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }, /* Random frame */ { 0xa3, 0xaf, 0x5f, 0xc6, 0x36, 0x43, 0x44, 0xab, 0xd9, 0x6d, 0x7d, 0x62, 0x24, 0xc9, 0xd2, 0x92, 0xfa, 0x27, 0x5d, 0x71, 0x7a, 0x59, 0xa8 }, /* jolly frame */ { 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17 }, }; /* 11-bit Access Burst soft-bits (payload only) from an EGPRS capable phone (BSIC 63) */ static const sbit_t test_rach_11bit[6][36] = { { 103, 109, -108, -110, 107, 108, -106, -120, -121, -120, -105, 122, -104, -109, 108, 109, -109, -111, 107, 111, -105, -119, -121, -104, 122, -120, 121, -99, -121, -120, -122, -106, 109, 109, -108, -111 }, { 103, 109, -109, -109, 106, 107, -106, -121, -121, -120, -106, 121, -120, 117, -122, 101, 109, -122, 120, -120, 101, 118, 120, 102, -125, 101, 110, -120, 121, -101, -121, -118, -121, -106, 108, 121 }, { -121, -122, -104, 123, -104, -108, 122, -104, -121, -121, -102, 124, -105, -110, 107, 109, -108, -109, 121, -122, 101, 107, -121, 105, 108, -110, -107, 124, -104, -109, 120, -122, 100, 122, 104, -123 }, { -122, -123, -103, 123, -105, -109, 122, -105, -121, -120, -104, 122, -120, 121, -101, -122, -120, -120, -119, -105, 120, -106, -108, 123, -104, -113, 105, 122, 101, -122, 119, -122, 117, -121, 119, -122 }, { 105, 110, -109, -109, 107, 108, -108, -120, -120, -121, -106, 121, -104, -107, 106, 108, -108, -108, 108, 107, -105, -120, -122, -104, 122, -119, 121, -103, -122, -118, -120, -106, 108, 108, -110, -111 }, { 120, -103, -123, -104, 119, -121, 100, 123, 106, -109, -107, 121, -122, 118, -121, 103, 108, -122, 120, -119, 121, -103, -121, -119, -121, -103, 124, -106, -108, 122, -103, -106, 121, -120, 119, -121 }, }; uint8_t test_speech_fr[33]; uint8_t test_speech_efr[31]; uint8_t test_speech_hr[15]; int main(int argc, char **argv) { int i, len_l2, len_mb; len_l2 = ARRAY_SIZE(test_l2); len_mb = ARRAY_SIZE(test_macblock); for (i = 0; i < len_l2; i++) test_xcch(test_l2[i]); for (i = 0; i < 256; i++) { test_rach(0x3f, i); test_rach(0x00, i); test_rach(0x1a, i); } for (i = 0; i < 2048; i++) { test_rach_ext(0x3f, i); test_rach_ext(0x00, i); test_rach_ext(0x1a, i); } for (i = 0; i < ARRAY_SIZE(test_rach_11bit); i++) test_rach_11bit_sample(0x3f, test_rach_11bit[i]); printf("\n"); for (i = 0; i < len_l2; i++) test_sch(test_l2[i]); for (i = 0; i < sizeof(test_speech_fr); i++) test_speech_fr[i] = i; test_speech_fr[0] = 0xd0; test_fr(test_speech_fr, sizeof(test_speech_fr)); for (i = 0; i < sizeof(test_speech_efr); i++) test_speech_efr[i] = i; test_speech_efr[0] = 0xc0; test_fr(test_speech_efr, sizeof(test_speech_efr)); for (i = 0; i < len_l2; i++) test_fr(test_l2[i], sizeof(test_l2[0])); for (i = 0; i < sizeof(test_speech_hr); i++) test_speech_hr[i] = i * 17; test_speech_hr[0] = 0x00; test_hr(test_speech_hr, sizeof(test_speech_hr)); for (i = 0; i < len_l2; i++) test_hr(test_l2[i], sizeof(test_l2[0])); for (i = 0; i < len_mb; i++) { if (test_macblock[i].is_egprs) { test_pdtch(&test_macblock[i], test_macblock[i].l2_len); } else { test_pdtch(&test_macblock[i], 23); test_pdtch(&test_macblock[i], 34); test_pdtch(&test_macblock[i], 40); test_pdtch(&test_macblock[i], 54); } } printf("Success\n"); return 0; }