mobile: loopback: support EFR

Related: SYS#4924
Change-Id: I73d1f88b0865ad97b85418ff76739febf2e128a7
This commit is contained in:
Oliver Smith 2020-04-27 15:56:36 +02:00
parent 8f04fa9758
commit 901ac89735
1 changed files with 23 additions and 4 deletions

View File

@ -22,7 +22,9 @@
#include <stdlib.h>
#include <osmocom/core/msgb.h>
#include <osmocom/codec/codec.h>
#include <osmocom/bb/common/logging.h>
#include <osmocom/bb/common/osmocom_data.h>
#include <osmocom/bb/mobile/mncc.h>
#include <osmocom/bb/mobile/voice.h>
@ -43,11 +45,14 @@ static int gsm_recv_voice(struct osmocom_ms *ms, struct msgb *msg)
msgb_push(msg, sizeof(struct gsm_data_frame));
mncc->callref = ms->mncc_entity.ref;
/* FIXME: FR only! */
/* FIXME: FR, EFR only! */
switch (ms->rrlayer.cd_now.mode) {
case GSM48_CMODE_SPEECH_V1:
mncc->msg_type = GSM_TCHF_FRAME;
break;
case GSM48_CMODE_SPEECH_EFR:
mncc->msg_type = GSM_TCHF_FRAME_EFR;
break;
default:
/* TODO: print error message here */
goto exit_free;
@ -73,12 +78,26 @@ exit_free:
int gsm_send_voice(struct osmocom_ms *ms, struct gsm_data_frame *data)
{
struct msgb *nmsg;
int len;
nmsg = msgb_alloc_headroom(33 + 64, 64, "TCH/F");
switch (ms->rrlayer.cd_now.mode) {
case GSM48_CMODE_SPEECH_V1:
/* FIXME: FR only, check for TCH/F (FR) and TCH/H (HR) */
len = GSM_FR_BYTES;
break;
case GSM48_CMODE_SPEECH_EFR:
len = GSM_EFR_BYTES;
break;
default:
LOGP(DL1C, LOGL_ERROR, "gsm_send_voice, msg_type=0x%02x: not implemented\n", data->msg_type);
return -EINVAL;
}
nmsg = msgb_alloc_headroom(len + 64, 64, "TCH/F");
if (!nmsg)
return -ENOMEM;
nmsg->l2h = msgb_put(nmsg, 33);
memcpy(nmsg->l2h, data->data, 33);
nmsg->l2h = msgb_put(nmsg, len);
memcpy(nmsg->l2h, data->data, len);
return gsm48_rr_tx_voice(ms, nmsg);
}