| /* |
| * (C) 2013 by Andreas Eversberg <jolly@eversberg.eu> |
| * (C) 2015 by Alexander Chemeris <Alexander.Chemeris@fairwaves.co> |
| * |
| * 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 <stdio.h> |
| #include <errno.h> |
| #include <unistd.h> |
| #include <string.h> |
| #include <stdlib.h> |
| |
| #include <osmocom/core/bits.h> |
| #include <osmocom/core/utils.h> |
| |
| #include <osmocom/coding/gsm0503_coding.h> |
| |
| #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_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"); |
| } |
| |
| static void test_pdtch(uint8_t *l2, int len) |
| { |
| uint8_t 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 */ |
| 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)); |
| rc = gsm0503_pdtch_encode(bursts_u, l2, len); |
| CHECK_RC_OR_RET(rc == GSM0503_GPRS_BURSTS_NBITS, "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 */ |
| 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 }, |
| }; |
| |
| uint8_t test_macblock[][54] = { |
| /* 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, 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 */ |
| { 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, |
| 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x10, |
| 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17 }, |
| }; |
| |
| 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 < 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++) { |
| 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; |
| } |