1 files changed, 106 insertions, 0 deletions
diff --git a/src/host/virt_phy/src/virt_prim_pdch.c b/src/host/virt_phy/src/virt_prim_pdch.c
new file mode 100644
index 00000000..7125a70b
--- /dev/null
+++ b/src/host/virt_phy/src/virt_prim_pdch.c
@@ -0,0 +1,106 @@
+/*
+ * (C) 2023 by sysmocom - s.f.m.c. GmbH <info@sysmocom.de>
+ * Author: Vadim Yanitskiy <vyanitskiy@sysmocom.de>
+ *
+ * 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 <stdint.h>
+
+#include <osmocom/core/msgb.h>
+#include <osmocom/core/utils.h>
+#include <osmocom/gsm/gsm_utils.h>
+#include <osmocom/gsm/protocol/gsm_08_58.h>
+
+#include <osmocom/bb/virtphy/l1ctl_sap.h>
+#include <osmocom/bb/virtphy/virt_l1_sched.h>
+#include <osmocom/bb/virtphy/gsmtapl1_if.h>
+#include <osmocom/bb/virtphy/logging.h>
+
+#include <osmocom/bb/l1ctl_proto.h>
+#include <osmocom/bb/l1gprs.h>
+
+void l1ctl_rx_gprs_uldl_tbf_cfg_req(struct l1_model_ms *ms, struct msgb *msg)
+{
+	const struct l1ctl_hdr *l1h = (struct l1ctl_hdr *)msg->data;
+
+	if (OSMO_UNLIKELY(ms->gprs == NULL)) {
+		LOGPMS(DL1C, LOGL_ERROR, ms, "l1gprs is not initialized\n");
+		return;
+	}
+
+	msg->l1h = msgb_pull(msg, sizeof(*l1h));
+
+	if (l1h->msg_type == L1CTL_GPRS_UL_TBF_CFG_REQ)
+		l1gprs_handle_ul_tbf_cfg_req(ms->gprs, msg);
+	else
+		l1gprs_handle_dl_tbf_cfg_req(ms->gprs, msg);
+}
+
+void l1ctl_rx_gprs_ul_block_req(struct l1_model_ms *ms, struct msgb *msg)
+{
+	const struct l1ctl_hdr *l1h = (struct l1ctl_hdr *)msg->data;
+	struct l1gprs_prim_ul_block_req req;
+	uint32_t fn_sched;
+
+	if (OSMO_UNLIKELY(ms->gprs == NULL)) {
+		LOGPMS(DL1P, LOGL_ERROR, ms, "l1gprs is not initialized\n");
+		return;
+	}
+
+	msg->l1h = (void *)l1h->data;
+	if (l1gprs_handle_ul_block_req(ms->gprs, &req, msg) != 0)
+		return;
+	msg->l2h = (void *)&req.data[0];
+
+	fn_sched = sched_fn_ul(ms->state.current_time,
+			       RSL_CHAN_OSMO_PDCH | req.hdr.tn, 0x00);
+	if (OSMO_UNLIKELY(fn_sched != req.hdr.fn)) {
+		LOGPMS(DL1P, LOGL_ERROR, ms,
+		       "GPRS UL BLOCK.req: fn_sched(%u) != fn_req(%u)\n",
+		       fn_sched, req.hdr.fn);
+		/* FIXME: return; */
+	}
+
+	virt_l1_sched_schedule(ms, msg, fn_sched, req.hdr.tn,
+			       &gsmtapl1_tx_to_virt_um_inst);
+}
+
+void l1ctl_tx_gprs_dl_block_ind(struct l1_model_ms *ms, const struct msgb *msg,
+				uint32_t fn, uint8_t tn, uint8_t rxlev)
+{
+	struct l1gprs_prim_dl_block_ind ind;
+	struct msgb *nmsg;
+
+	if (ms->gprs == NULL)
+		return;
+
+	ind = (struct l1gprs_prim_dl_block_ind) {
+		.hdr = {
+			.fn = fn,
+			.tn = tn,
+		},
+		.meas = {
+			.ber10k = 0, /* perfect Um, no errors */
+			.ci_cb = 180, /* 18 dB */
+			.rx_lev = rxlev,
+		},
+		.data = msgb_data(msg),
+		.data_len = msgb_length(msg),
+	};
+
+	nmsg = l1gprs_handle_dl_block_ind(ms->gprs, &ind);
+	if (nmsg != NULL)
+		l1ctl_sap_tx_to_l23_inst(ms, nmsg);
+}