/* * TbfTest.cpp * * Copyright (C) 2013 by Holger Hans Peter Freyther * * All Rights Reserved * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU Affero General Public License as published by * the Free Software Foundation; either version 3 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 Affero General Public License * along with this program. If not, see . * */ #include "bts.h" #include "tbf.h" #include "gprs_debug.h" #include "pcu_utils.h" #include "gprs_bssgp_pcu.h" #include "pcu_l1_if.h" extern "C" { #include "pcu_vty.h" #include #include #include #include #include } #include void *tall_pcu_ctx; int16_t spoof_mnc = 0, spoof_mcc = 0; static void check_tbf(gprs_rlcmac_tbf *tbf) { OSMO_ASSERT(tbf); } /* static unsigned inc_fn(fn) { unsigned next_fn; next_fn = fn + 4; if ((block_nr % 3) == 2) next_fn ++; next_fn = next_fn % 2715648; return next_fn; } */ static void test_tbf_tlli_update() { BTS the_bts; GprsMs *ms, *ms_new; the_bts.bts_data()->alloc_algorithm = alloc_algorithm_a; the_bts.bts_data()->trx[0].pdch[2].enable(); the_bts.bts_data()->trx[0].pdch[3].enable(); /* * Make a uplink and downlink allocation */ gprs_rlcmac_tbf *dl_tbf = tbf_alloc_dl_tbf(the_bts.bts_data(), NULL, 0, 0, 0, 0); dl_tbf->update_tlli(0x2342); dl_tbf->update_ms(0x2342, GPRS_RLCMAC_DL_TBF); dl_tbf->set_ta(4); gprs_rlcmac_tbf *ul_tbf = tbf_alloc_ul_tbf(the_bts.bts_data(), dl_tbf, 0, 0, 0, 0); ul_tbf->update_tlli(0x2342); ul_tbf->update_ms(0x2342, GPRS_RLCMAC_UL_TBF); ms = the_bts.ms_by_tlli(0x2342); OSMO_ASSERT(ms != NULL); OSMO_ASSERT(ms->dl_tbf() == dl_tbf); OSMO_ASSERT(ms->ul_tbf() == ul_tbf); /* * Now check.. that DL changes and that the timing advance * has changed. */ dl_tbf->update_tlli(0x4232); dl_tbf->update_ms(0x4232, GPRS_RLCMAC_DL_TBF); /* It is still there, since the new TLLI has not been used for UL yet */ ms_new = the_bts.ms_by_tlli(0x2342); OSMO_ASSERT(ms == ms_new); ms_new = the_bts.ms_by_tlli(0x4232); OSMO_ASSERT(ms == ms_new); OSMO_ASSERT(ms->dl_tbf() == dl_tbf); OSMO_ASSERT(ms->ul_tbf() == ul_tbf); /* Now use the new TLLI for UL */ ul_tbf->update_ms(0x4232, GPRS_RLCMAC_UL_TBF); ms_new = the_bts.ms_by_tlli(0x2342); OSMO_ASSERT(ms_new == NULL); ms_new = the_bts.ms_by_tlli(0x4232); OSMO_ASSERT(ms_new != NULL); OSMO_ASSERT(ms_new->ta() == 4); OSMO_ASSERT(ul_tbf->ta() == 4); OSMO_ASSERT(dl_tbf->ta() == 4); ul_tbf->set_ta(6); OSMO_ASSERT(ul_tbf->ta() == 6); OSMO_ASSERT(dl_tbf->ta() == 6); } static uint8_t llc_data[200]; int pcu_sock_send(struct msgb *msg) { return 0; } static void setup_bts(BTS *the_bts, uint8_t ts_no, uint8_t cs = 1) { gprs_rlcmac_bts *bts; gprs_rlcmac_trx *trx; bts = the_bts->bts_data(); bts->alloc_algorithm = alloc_algorithm_a; bts->initial_cs_dl = cs; bts->initial_cs_ul = cs; trx = &bts->trx[0]; trx->pdch[ts_no].enable(); } static gprs_rlcmac_dl_tbf *create_dl_tbf(BTS *the_bts, uint8_t ms_class, uint8_t *trx_no_) { gprs_rlcmac_bts *bts; int tfi; uint8_t trx_no; gprs_rlcmac_dl_tbf *dl_tbf; bts = the_bts->bts_data(); tfi = the_bts->tfi_find_free(GPRS_RLCMAC_DL_TBF, &trx_no, -1); OSMO_ASSERT(tfi >= 0); dl_tbf = tbf_alloc_dl_tbf(bts, NULL, tfi, trx_no, ms_class, 1); check_tbf(dl_tbf); /* "Establish" the DL TBF */ dl_tbf->dl_ass_state = GPRS_RLCMAC_DL_ASS_SEND_ASS; dl_tbf->set_state(GPRS_RLCMAC_FLOW); dl_tbf->m_wait_confirm = 0; check_tbf(dl_tbf); *trx_no_ = trx_no; return dl_tbf; } static void send_rlc_block(struct gprs_rlcmac_bts *bts, uint8_t trx_no, uint8_t ts_no, uint16_t arfcn, uint32_t *fn, uint8_t *block_nr) { gprs_rlcmac_rcv_rts_block(bts, trx_no, ts_no, 0, *fn, *block_nr); *fn += 4; if ((*fn % 13) == 12) *fn += 1; *block_nr += 1; } enum test_tbf_final_ack_mode { TEST_MODE_STANDARD, TEST_MODE_REVERSE_FREE }; static void test_tbf_final_ack(enum test_tbf_final_ack_mode test_mode) { BTS the_bts; gprs_rlcmac_bts *bts; uint8_t ts_no = 4; unsigned i; uint8_t ms_class = 45; uint32_t fn; uint8_t block_nr; uint8_t trx_no; GprsMs *ms; uint32_t tlli = 0xffeeddcc; uint8_t rbb[64/8]; gprs_rlcmac_dl_tbf *dl_tbf; gprs_rlcmac_tbf *new_tbf; bts = the_bts.bts_data(); setup_bts(&the_bts, ts_no); dl_tbf = create_dl_tbf(&the_bts, ms_class, &trx_no); dl_tbf->update_ms(tlli, GPRS_RLCMAC_DL_TBF); ms = dl_tbf->ms(); for (i = 0; i < sizeof(llc_data); i++) llc_data[i] = i%256; /* Schedule two LLC frames */ dl_tbf->append_data(ms_class, 1000, llc_data, sizeof(llc_data)); dl_tbf->append_data(ms_class, 1000, llc_data, sizeof(llc_data)); /* Send only a few RLC/MAC blocks */ fn = 0; block_nr = 0; while (block_nr < 3) { /* Request to send one block */ send_rlc_block(bts, trx_no, ts_no, 0, &fn, &block_nr); } OSMO_ASSERT(dl_tbf->have_data()); OSMO_ASSERT(dl_tbf->state_is(GPRS_RLCMAC_FLOW)); /* Queue a final ACK */ memset(rbb, 0, sizeof(rbb)); /* Receive a final ACK */ dl_tbf->rcvd_dl_ack(1, 1, rbb); /* Clean up and ensure tbfs are in the correct state */ OSMO_ASSERT(dl_tbf->state_is(GPRS_RLCMAC_WAIT_RELEASE)); new_tbf = ms->dl_tbf(); check_tbf(new_tbf); OSMO_ASSERT(new_tbf != dl_tbf); OSMO_ASSERT(new_tbf->tfi() == 1); check_tbf(dl_tbf); dl_tbf->dl_ass_state = GPRS_RLCMAC_DL_ASS_NONE; if (test_mode == TEST_MODE_REVERSE_FREE) { GprsMs::Guard guard(ms); tbf_free(new_tbf); OSMO_ASSERT(ms->dl_tbf() == NULL); check_tbf(dl_tbf); tbf_free(dl_tbf); } else { GprsMs::Guard guard(ms); tbf_free(dl_tbf); OSMO_ASSERT(ms->dl_tbf() == new_tbf); check_tbf(new_tbf); tbf_free(new_tbf); OSMO_ASSERT(ms->dl_tbf() == NULL); } } static void test_tbf_delayed_release() { BTS the_bts; gprs_rlcmac_bts *bts; uint8_t ts_no = 4; unsigned i; uint8_t ms_class = 45; uint32_t fn = 0; uint8_t block_nr = 0; uint8_t trx_no; uint32_t tlli = 0xffeeddcc; uint8_t rbb[64/8]; gprs_rlcmac_dl_tbf *dl_tbf; printf("=== start %s ===\n", __func__); bts = the_bts.bts_data(); setup_bts(&the_bts, ts_no); bts->dl_tbf_idle_msec = 200; dl_tbf = create_dl_tbf(&the_bts, ms_class, &trx_no); dl_tbf->update_ms(tlli, GPRS_RLCMAC_DL_TBF); for (i = 0; i < sizeof(llc_data); i++) llc_data[i] = i%256; OSMO_ASSERT(dl_tbf->state_is(GPRS_RLCMAC_FLOW)); /* Schedule two LLC frames */ dl_tbf->append_data(ms_class, 1000, llc_data, sizeof(llc_data)); dl_tbf->append_data(ms_class, 1000, llc_data, sizeof(llc_data)); OSMO_ASSERT(dl_tbf->state_is(GPRS_RLCMAC_FLOW)); /* Drain the queue */ while (dl_tbf->have_data()) /* Request to send one RLC/MAC block */ send_rlc_block(bts, trx_no, ts_no, 0, &fn, &block_nr); OSMO_ASSERT(dl_tbf->state_is(GPRS_RLCMAC_FLOW)); /* ACK all blocks */ memset(rbb, 0xff, sizeof(rbb)); /* Receive an ACK */ dl_tbf->rcvd_dl_ack(0, dl_tbf->m_window.v_s(), rbb); OSMO_ASSERT(dl_tbf->m_window.window_empty()); /* Force sending of a single block containing an LLC dummy command */ send_rlc_block(bts, trx_no, ts_no, 0, &fn, &block_nr); /* Receive an ACK */ dl_tbf->rcvd_dl_ack(0, dl_tbf->m_window.v_s(), rbb); OSMO_ASSERT(dl_tbf->m_window.window_empty()); /* Timeout (make sure fn % 52 remains valid) */ fn += 52 * ((msecs_to_frames(bts->dl_tbf_idle_msec + 100) + 51)/ 52); send_rlc_block(bts, trx_no, ts_no, 0, &fn, &block_nr); OSMO_ASSERT(dl_tbf->state_is(GPRS_RLCMAC_FINISHED)); /* Receive a final ACK */ dl_tbf->rcvd_dl_ack(1, dl_tbf->m_window.v_s(), rbb); /* Clean up and ensure tbfs are in the correct state */ OSMO_ASSERT(dl_tbf->state_is(GPRS_RLCMAC_WAIT_RELEASE)); dl_tbf->dl_ass_state = GPRS_RLCMAC_DL_ASS_NONE; check_tbf(dl_tbf); tbf_free(dl_tbf); printf("=== end %s ===\n", __func__); } static void test_tbf_imsi() { BTS the_bts; uint8_t ts_no = 4; uint8_t ms_class = 45; uint8_t trx_no; GprsMs *ms1, *ms2; gprs_rlcmac_dl_tbf *dl_tbf[2]; printf("=== start %s ===\n", __func__); setup_bts(&the_bts, ts_no); dl_tbf[0] = create_dl_tbf(&the_bts, ms_class, &trx_no); dl_tbf[1] = create_dl_tbf(&the_bts, ms_class, &trx_no); dl_tbf[0]->update_ms(0xf1000001, GPRS_RLCMAC_DL_TBF); dl_tbf[1]->update_ms(0xf1000002, GPRS_RLCMAC_DL_TBF); dl_tbf[0]->assign_imsi("001001000000001"); ms1 = the_bts.ms_store().get_ms(0, 0, "001001000000001"); OSMO_ASSERT(ms1 != NULL); ms2 = the_bts.ms_store().get_ms(0xf1000001); OSMO_ASSERT(ms2 != NULL); OSMO_ASSERT(strcmp(ms2->imsi(), "001001000000001") == 0); OSMO_ASSERT(ms1 == ms2); /* change the IMSI on TBF 0 */ dl_tbf[0]->assign_imsi("001001000000002"); ms1 = the_bts.ms_store().get_ms(0, 0, "001001000000001"); OSMO_ASSERT(ms1 == NULL); ms1 = the_bts.ms_store().get_ms(0, 0, "001001000000002"); OSMO_ASSERT(ms1 != NULL); OSMO_ASSERT(strcmp(ms2->imsi(), "001001000000002") == 0); OSMO_ASSERT(ms1 == ms2); /* use the same IMSI on TBF 2 */ dl_tbf[1]->assign_imsi("001001000000002"); ms1 = the_bts.ms_store().get_ms(0, 0, "001001000000002"); OSMO_ASSERT(ms1 != NULL); OSMO_ASSERT(ms1 != ms2); OSMO_ASSERT(strcmp(ms1->imsi(), "001001000000002") == 0); OSMO_ASSERT(strcmp(ms2->imsi(), "") == 0); tbf_free(dl_tbf[1]); ms1 = the_bts.ms_store().get_ms(0, 0, "001001000000002"); OSMO_ASSERT(ms1 == NULL); tbf_free(dl_tbf[0]); printf("=== end %s ===\n", __func__); } static void test_tbf_exhaustion() { BTS the_bts; gprs_rlcmac_bts *bts; unsigned i; uint8_t ts_no = 4; uint8_t ms_class = 45; int rc = 0; uint8_t buf[256] = {0}; printf("=== start %s ===\n", __func__); bts = the_bts.bts_data(); setup_bts(&the_bts, ts_no); gprs_bssgp_create_and_connect(bts, 33001, 0, 33001, 1234, 1234, 1234, 1, 1, 0, 0, 0); for (i = 0; i < 1024; i++) { uint32_t tlli = 0xc0000000 + i; char imsi[16] = {0}; unsigned delay_csec = 1000; snprintf(imsi, sizeof(imsi), "001001%09d", i); rc = gprs_rlcmac_dl_tbf::handle(bts, tlli, 0, imsi, ms_class, delay_csec, buf, sizeof(buf)); if (rc < 0) break; } OSMO_ASSERT(rc == -EBUSY); printf("=== end %s ===\n", __func__); gprs_bssgp_destroy(); } static void test_tbf_dl_llc_loss() { BTS the_bts; gprs_rlcmac_bts *bts; uint8_t ts_no = 4; uint8_t ms_class = 45; int rc = 0; uint32_t tlli = 0xc0123456; const char *imsi = "001001000123456"; unsigned delay_csec = 1000; GprsMs *ms; uint8_t buf[19]; printf("=== start %s ===\n", __func__); bts = the_bts.bts_data(); setup_bts(&the_bts, ts_no); bts->ms_idle_sec = 10; /* keep the MS object */ gprs_bssgp_create_and_connect(bts, 33001, 0, 33001, 1234, 1234, 1234, 1, 1, 0, 0, 0); /* Handle LLC frame 1 */ memset(buf, 1, sizeof(buf)); rc = gprs_rlcmac_dl_tbf::handle(bts, tlli, 0, imsi, ms_class, delay_csec, buf, sizeof(buf)); OSMO_ASSERT(rc >= 0); ms = the_bts.ms_store().get_ms(0, 0, imsi); OSMO_ASSERT(ms != NULL); OSMO_ASSERT(ms->dl_tbf() != NULL); /* Handle LLC frame 2 */ memset(buf, 2, sizeof(buf)); rc = gprs_rlcmac_dl_tbf::handle(bts, tlli, 0, imsi, ms_class, delay_csec, buf, sizeof(buf)); OSMO_ASSERT(rc >= 0); /* TBF establishment fails (timeout) */ tbf_free(ms->dl_tbf()); /* Handle LLC frame 3 */ memset(buf, 3, sizeof(buf)); rc = gprs_rlcmac_dl_tbf::handle(bts, tlli, 0, imsi, ms_class, delay_csec, buf, sizeof(buf)); OSMO_ASSERT(rc >= 0); OSMO_ASSERT(ms->dl_tbf() != NULL); /* Get first BSN */ struct msgb *msg; int fn = 0; uint8_t expected_data = 1; while (ms->dl_tbf()->have_data()) { msg = ms->dl_tbf()->create_dl_acked_block(fn += 4, 7); fprintf(stderr, "MSG = %s\n", msgb_hexdump(msg)); OSMO_ASSERT(msgb_length(msg) == 23); OSMO_ASSERT(msgb_data(msg)[10] == expected_data); expected_data += 1; } OSMO_ASSERT(expected_data-1 == 3); printf("=== end %s ===\n", __func__); gprs_bssgp_destroy(); } static void test_tbf_single_phase() { BTS the_bts; GprsMs *ms; int ts_no = 7; uint32_t fn = 2654167; /* 17,25,9 */ uint16_t qta = 31; uint8_t trx_no = 0; int tfi = 0; gprs_rlcmac_ul_tbf *ul_tbf; struct gprs_rlcmac_pdch *pdch; struct pcu_l1_meas meas; printf("=== start %s ===\n", __func__); setup_bts(&the_bts, ts_no); tfi = the_bts.tfi_find_free(GPRS_RLCMAC_UL_TBF, &trx_no, -1); the_bts.rcv_rach(0x03, fn, qta); ul_tbf = the_bts.ul_tbf_by_tfi(tfi, trx_no); OSMO_ASSERT(ul_tbf != NULL); fprintf(stderr, "Got '%s', TA=%d\n", ul_tbf->name(), ul_tbf->ta()); OSMO_ASSERT(ul_tbf->ta() == qta / 4); uint8_t data_msg[23] = { 0x00, /* GPRS_RLCMAC_DATA_BLOCK << 6 */ uint8_t(1 | (tfi << 2)), uint8_t(1), /* BSN:7, E:1 */ 0xf1, 0x22, 0x33, 0x44, /* TLLI */ }; pdch = &the_bts.bts_data()->trx[trx_no].pdch[ts_no]; pdch->rcv_block(&data_msg[0], sizeof(data_msg), fn, &meas); ms = the_bts.ms_by_tlli(0xf1223344); OSMO_ASSERT(ms != NULL); fprintf(stderr, "Got MS: TLLI = 0x%08x, TA = %d\n", ms->tlli(), ms->ta()); OSMO_ASSERT(ms->ta() == qta/4); printf("=== end %s ===\n", __func__); } static void test_tbf_two_phase() { BTS the_bts; GprsMs *ms; int ts_no = 7; uint32_t rach_fn = 2654167; /* 17,25,9 */ uint32_t rts_fn = 2654218; uint8_t rts_bn = 8; uint16_t qta = 31; uint8_t trx_no = 0; int tfi = 0; const uint32_t tlli = 0xf1223344; gprs_rlcmac_ul_tbf *ul_tbf; struct gprs_rlcmac_pdch *pdch; gprs_rlcmac_bts *bts; RlcMacUplink_t ulreq = {0}; bitvec *rlc_block; uint8_t buf[64]; int num_bytes; struct pcu_l1_meas meas; meas.set_rssi(31); printf("=== start %s ===\n", __func__); setup_bts(&the_bts, ts_no, 4); bts = the_bts.bts_data(); /* needed to set last_rts_fn in the PDCH object */ send_rlc_block(bts, trx_no, ts_no, 0, &rts_fn, &rts_bn); /* simulate RACH, this sends an Immediate Assignment Uplink on the AGCH */ the_bts.rcv_rach(0x73, rach_fn, qta); /* get next free TFI */ tfi = the_bts.tfi_find_free(GPRS_RLCMAC_UL_TBF, &trx_no, -1); /* fake a resource request */ rlc_block = bitvec_alloc(23); ulreq.u.MESSAGE_TYPE = MT_PACKET_RESOURCE_REQUEST; ulreq.u.Packet_Resource_Request.PayloadType = GPRS_RLCMAC_CONTROL_BLOCK; ulreq.u.Packet_Resource_Request.ID.UnionType = 1; /* != 0 */ ulreq.u.Packet_Resource_Request.ID.u.TLLI = tlli; encode_gsm_rlcmac_uplink(rlc_block, &ulreq); num_bytes = bitvec_pack(rlc_block, &buf[0]); OSMO_ASSERT(size_t(num_bytes) < sizeof(buf)); bitvec_free(rlc_block); pdch = &the_bts.bts_data()->trx[trx_no].pdch[ts_no]; pdch->rcv_block(&buf[0], num_bytes, 2654270, &meas); /* check the TBF */ ul_tbf = the_bts.ul_tbf_by_tfi(tfi, trx_no); OSMO_ASSERT(ul_tbf != NULL); fprintf(stderr, "Got '%s', TA=%d, CS=%d\n", ul_tbf->name(), ul_tbf->ta(), ul_tbf->current_cs()); OSMO_ASSERT(ul_tbf->ta() == qta / 4); /* send packet uplink assignment */ rts_fn += 52; rts_bn += 12; send_rlc_block(bts, trx_no, ts_no, 0, &rts_fn, &rts_bn); /* send fake data */ uint8_t data_msg[23] = { 0x00, /* GPRS_RLCMAC_DATA_BLOCK << 6 */ uint8_t(0 | (tfi << 2)), uint8_t(1), /* BSN:7, E:1 */ }; pdch->rcv_block(&data_msg[0], sizeof(data_msg), rts_fn, &meas); ms = the_bts.ms_by_tlli(0xf1223344); OSMO_ASSERT(ms != NULL); fprintf(stderr, "Got MS: TLLI = 0x%08x, TA = %d\n", ms->tlli(), ms->ta()); OSMO_ASSERT(ms->ta() == qta/4); printf("=== end %s ===\n", __func__); } static const struct log_info_cat default_categories[] = { {"DCSN1", "\033[1;31m", "Concrete Syntax Notation One (CSN1)", LOGL_INFO, 0}, {"DL1IF", "\033[1;32m", "GPRS PCU L1 interface (L1IF)", LOGL_DEBUG, 1}, {"DRLCMAC", "\033[0;33m", "GPRS RLC/MAC layer (RLCMAC)", LOGL_DEBUG, 1}, {"DRLCMACDATA", "\033[0;33m", "GPRS RLC/MAC layer Data (RLCMAC)", LOGL_DEBUG, 1}, {"DRLCMACDL", "\033[1;33m", "GPRS RLC/MAC layer Downlink (RLCMAC)", LOGL_DEBUG, 1}, {"DRLCMACUL", "\033[1;36m", "GPRS RLC/MAC layer Uplink (RLCMAC)", LOGL_DEBUG, 1}, {"DRLCMACSCHED", "\033[0;36m", "GPRS RLC/MAC layer Scheduling (RLCMAC)", LOGL_DEBUG, 1}, {"DRLCMACMEAS", "\033[1;31m", "GPRS RLC/MAC layer Measurements (RLCMAC)", LOGL_INFO, 1}, {"DBSSGP","\033[1;34m", "GPRS BSS Gateway Protocol (BSSGP)", LOGL_INFO , 1}, {"DPCU", "\033[1;35m", "GPRS Packet Control Unit (PCU)", LOGL_NOTICE, 1}, }; static int filter_fn(const struct log_context *ctx, struct log_target *tar) { return 1; } const struct log_info debug_log_info = { filter_fn, (struct log_info_cat*)default_categories, ARRAY_SIZE(default_categories), }; int main(int argc, char **argv) { struct vty_app_info pcu_vty_info = {0}; tall_pcu_ctx = talloc_named_const(NULL, 1, "moiji-mobile TbfTest context"); if (!tall_pcu_ctx) abort(); msgb_set_talloc_ctx(tall_pcu_ctx); osmo_init_logging(&debug_log_info); log_set_use_color(osmo_stderr_target, 0); log_set_print_filename(osmo_stderr_target, 0); bssgp_set_log_ss(DBSSGP); vty_init(&pcu_vty_info); pcu_vty_init(&debug_log_info); test_tbf_tlli_update(); test_tbf_final_ack(TEST_MODE_STANDARD); test_tbf_final_ack(TEST_MODE_REVERSE_FREE); test_tbf_delayed_release(); test_tbf_imsi(); test_tbf_exhaustion(); test_tbf_dl_llc_loss(); test_tbf_single_phase(); test_tbf_two_phase(); if (getenv("TALLOC_REPORT_FULL")) talloc_report_full(tall_pcu_ctx, stderr); return EXIT_SUCCESS; } /* * stubs that should not be reached */ extern "C" { void l1if_pdch_req() { abort(); } void l1if_connect_pdch() { abort(); } void l1if_close_pdch() { abort(); } void l1if_open_pdch() { abort(); } }