mobile: Begin with a primitive interface on top of the code

We want the script interface to interface through a primitive
interface. This will allow to move it to a different thread or
a process in the future. The script interface will just use the
primitives.

It is not clear how "sap" will be used here. I am keeping it
at 0 right now. The first primitive is starting a timer with a
request and then getting an indication as a response.

Change-Id: Id2456b7fae35546553c4805f12a40c0812d9255c

1 files changed, 135 insertions, 0 deletions

diff --git a/src/host/layer23/src/mobile/primitives.c b/src/host/layer23/src/mobile/primitives.c
new file mode 100644
index 00000000..efa7f3ff
--- /dev/null
+++ b/src/host/layer23/src/mobile/primitives.c
@@ -0,0 +1,135 @@
+/* (C) 2017 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 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 <osmocom/bb/mobile/primitives.h>
+#include <osmocom/bb/common/logging.h>
+
+#include <osmocom/core/timer.h>
+#include <osmocom/core/talloc.h>
+
+struct timer_closure {
+	struct llist_head entry;
+	struct mobile_prim_intf *intf;
+	struct osmo_timer_list timer;
+	uint64_t id;
+};
+
+struct mobile_prim_intf *mobile_prim_intf_alloc(struct osmocom_ms *ms)
+{
+	struct mobile_prim_intf *intf;
+
+	intf = talloc_zero(ms, struct mobile_prim_intf);
+	intf->ms = ms;
+
+	INIT_LLIST_HEAD(&intf->timers);
+	return intf;
+}
+
+void mobile_prim_intf_free(struct mobile_prim_intf *intf)
+{
+	struct timer_closure *timer, *tmp;
+
+	llist_for_each_entry_safe(timer, tmp, &intf->timers, entry) {
+		osmo_timer_del(&timer->timer);
+		llist_del(&timer->entry);
+		talloc_free(timer);
+	}
+	talloc_free(intf);
+}
+
+struct mobile_prim *mobile_prim_alloc(unsigned int primitive, enum osmo_prim_operation op)
+{
+	struct msgb *msg = msgb_alloc(1024, "Mobile Primitive");
+	struct mobile_prim *prim = (struct mobile_prim *) msgb_put(msg, sizeof(*prim));
+	osmo_prim_init(&prim->hdr, 0, primitive, op, msg);
+	msg->l2h = msg->tail;
+	return prim;
+}
+
+static void timer_expired_cb(void *_closure)
+{
+	struct timer_closure *closure = _closure;
+	struct mobile_prim_intf *intf;
+	struct mobile_prim *prim;
+
+	prim = mobile_prim_alloc(PRIM_MOB_TIMER, PRIM_OP_INDICATION);
+	intf = closure->intf;
+	prim->u.timer.timer_id = closure->id;
+
+	llist_del(&closure->entry);
+	talloc_free(closure);
+
+	intf->indication(intf, prim);
+}
+
+static int create_timer(struct mobile_prim_intf *intf, struct mobile_timer_param *param)
+{
+	struct timer_closure *closure;
+
+	LOGP(DPRIM, LOGL_DEBUG, "Creating timer with reference: %llu\n", param->timer_id);
+
+	closure = talloc_zero(intf, struct timer_closure);
+	closure->intf = intf;
+	closure->id = param->timer_id;
+	closure->timer.cb = timer_expired_cb;
+	closure->timer.data = closure;
+	llist_add_tail(&closure->entry, &intf->timers);
+	osmo_timer_schedule(&closure->timer, param->seconds, 0);
+	return 0;
+}
+
+static int cancel_timer(struct mobile_prim_intf *intf, struct mobile_timer_param *param)
+{
+	struct timer_closure *closure;
+
+
+	llist_for_each_entry(closure, &intf->timers, entry) {
+		if (closure->id != param->timer_id)
+			continue;
+
+		LOGP(DPRIM, LOGL_DEBUG,
+			"Canceling timer with reference: %llu\n", param->timer_id);
+		osmo_timer_del(&closure->timer);
+		llist_del(&closure->entry);
+		talloc_free(closure);
+		return 0;
+	}
+	return -1;
+}
+
+int mobile_prim_intf_req(struct mobile_prim_intf *intf, struct mobile_prim *prim)
+{
+	int rc = 0;
+
+	switch (OSMO_PRIM_HDR(&prim->hdr)) {
+	case OSMO_PRIM(PRIM_MOB_TIMER, PRIM_OP_REQUEST):
+		rc = create_timer(intf, &prim->u.timer);
+		break;
+	case OSMO_PRIM(PRIM_MOB_TIMER_CANCEL, PRIM_OP_REQUEST):
+		rc = cancel_timer(intf, &prim->u.timer);
+		break;
+	default:
+		LOGP(DPRIM, LOGL_ERROR, "Unknown primitive: %d\n", OSMO_PRIM_HDR(&prim->hdr));
+		break;
+	}
+
+	msgb_free(prim->hdr.msg);
+	return rc;
+}