132 lines
3.5 KiB
C
132 lines
3.5 KiB
C
/*
|
|
* OsmocomBB <-> SDR connection bridge
|
|
* TDMA scheduler: common routines for lchan handlers
|
|
*
|
|
* (C) 2017-2022 by Vadim Yanitskiy <axilirator@gmail.com>
|
|
* Contributions by sysmocom - s.f.m.c. GmbH
|
|
*
|
|
* 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.
|
|
*
|
|
*/
|
|
|
|
#include <errno.h>
|
|
#include <string.h>
|
|
#include <talloc.h>
|
|
#include <stdint.h>
|
|
#include <stdbool.h>
|
|
|
|
#include <arpa/inet.h>
|
|
|
|
#include <osmocom/core/logging.h>
|
|
#include <osmocom/core/bits.h>
|
|
|
|
#include <osmocom/codec/codec.h>
|
|
|
|
#include <osmocom/gsm/protocol/gsm_04_08.h>
|
|
#include <osmocom/gsm/protocol/gsm_08_58.h>
|
|
|
|
#include <osmocom/bb/l1sched/l1sched.h>
|
|
#include <osmocom/bb/trxcon/logging.h>
|
|
|
|
/* GSM 05.02 Chapter 5.2.3 Normal Burst (NB) */
|
|
const uint8_t l1sched_nb_training_bits[8][26] = {
|
|
{
|
|
0, 0, 1, 0, 0, 1, 0, 1, 1, 1, 0, 0, 0,
|
|
0, 1, 0, 0, 0, 1, 0, 0, 1, 0, 1, 1, 1,
|
|
},
|
|
{
|
|
0, 0, 1, 0, 1, 1, 0, 1, 1, 1, 0, 1, 1,
|
|
1, 1, 0, 0, 0, 1, 0, 1, 1, 0, 1, 1, 1,
|
|
},
|
|
{
|
|
0, 1, 0, 0, 0, 0, 1, 1, 1, 0, 1, 1, 1,
|
|
0, 1, 0, 0, 1, 0, 0, 0, 0, 1, 1, 1, 0,
|
|
},
|
|
{
|
|
0, 1, 0, 0, 0, 1, 1, 1, 1, 0, 1, 1, 0,
|
|
1, 0, 0, 0, 1, 0, 0, 0, 1, 1, 1, 1, 0,
|
|
},
|
|
{
|
|
0, 0, 0, 1, 1, 0, 1, 0, 1, 1, 1, 0, 0,
|
|
1, 0, 0, 0, 0, 0, 1, 1, 0, 1, 0, 1, 1,
|
|
},
|
|
{
|
|
0, 1, 0, 0, 1, 1, 1, 0, 1, 0, 1, 1, 0,
|
|
0, 0, 0, 0, 1, 0, 0, 1, 1, 1, 0, 1, 0,
|
|
},
|
|
{
|
|
1, 0, 1, 0, 0, 1, 1, 1, 1, 1, 0, 1, 1,
|
|
0, 0, 0, 1, 0, 1, 0, 0, 1, 1, 1, 1, 1,
|
|
},
|
|
{
|
|
1, 1, 1, 0, 1, 1, 1, 1, 0, 0, 0, 1, 0,
|
|
0, 1, 0, 1, 1, 1, 0, 1, 1, 1, 1, 0, 0,
|
|
},
|
|
};
|
|
|
|
/* Get a string representation of the burst buffer's completeness.
|
|
* Examples: " ****.." (incomplete, 4/6 bursts)
|
|
* " ****" (complete, all 4 bursts)
|
|
* "**.***.." (incomplete, 5/8 bursts) */
|
|
const char *l1sched_burst_mask2str(const uint8_t *mask, int bits)
|
|
{
|
|
/* TODO: CSD is interleaved over 22 bursts, so the mask needs to be extended */
|
|
static char buf[8 + 1];
|
|
char *ptr = buf;
|
|
|
|
OSMO_ASSERT(bits <= 8 && bits > 0);
|
|
|
|
while (--bits >= 0)
|
|
*(ptr++) = (*mask & (1 << bits)) ? '*' : '.';
|
|
*ptr = '\0';
|
|
|
|
return buf;
|
|
}
|
|
|
|
/**
|
|
* Composes a bad frame indication message
|
|
* according to the current tch_mode.
|
|
*
|
|
* @param l2 Caller-allocated byte array
|
|
* @param lchan Logical channel to generate BFI for
|
|
* @return How much bytes were written
|
|
*/
|
|
size_t l1sched_bad_frame_ind(uint8_t *l2, struct l1sched_lchan_state *lchan)
|
|
{
|
|
switch (lchan->tch_mode) {
|
|
case GSM48_CMODE_SPEECH_V1:
|
|
if (lchan->type == L1SCHED_TCHF) { /* Full Rate */
|
|
memset(l2, 0x00, GSM_FR_BYTES);
|
|
l2[0] = 0xd0;
|
|
return GSM_FR_BYTES;
|
|
} else { /* Half Rate */
|
|
memset(l2 + 1, 0x00, GSM_HR_BYTES);
|
|
l2[0] = 0x70; /* F = 0, FT = 111 */
|
|
return GSM_HR_BYTES + 1;
|
|
}
|
|
case GSM48_CMODE_SPEECH_EFR: /* Enhanced Full Rate */
|
|
memset(l2, 0x00, GSM_EFR_BYTES);
|
|
l2[0] = 0xc0;
|
|
return GSM_EFR_BYTES;
|
|
case GSM48_CMODE_SPEECH_AMR: /* Adaptive Multi Rate */
|
|
/* FIXME: AMR is not implemented yet */
|
|
return 0;
|
|
case GSM48_CMODE_SIGN:
|
|
LOGP(DSCH, LOGL_ERROR, "BFI is not allowed in signalling mode\n");
|
|
return 0;
|
|
default:
|
|
LOGP(DSCH, LOGL_ERROR, "Invalid TCH mode: %u\n", lchan->tch_mode);
|
|
return 0;
|
|
}
|
|
}
|