rildev: plugin that creates ril-type modems

This plugin creates modems that use the rilmodem driver by looking at
environment variables: when OFONO_RIL_DEVICE exists it creates a ril
modem of the sub-type specified by the variable. OFONO_RIL_NUM_SIM_SLOTS
specifies the number of SIM slots for multi-SIM modems.

1 files changed, 133 insertions, 0 deletions

diff --git a/plugins/rildev.c b/plugins/rildev.c
new file mode 100644
index 00000000..461324df
--- /dev/null
+++ b/plugins/rildev.c
@@ -0,0 +1,133 @@
+/*
+ *
+ *  oFono - Open Source Telephony
+ *
+ *  Copyright (C) 2008-2011  Intel Corporation. All rights reserved.
+ *  Copyright (C) 2014 Canonical Ltd.
+ *
+ *  This program is free software; you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License version 2 as
+ *  published by the Free Software Foundation.
+ *
+ *  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 St, Fifth Floor, Boston, MA  02110-1301  USA
+ *
+ */
+
+#ifdef HAVE_CONFIG_H
+#include <config.h>
+#endif
+
+#include <errno.h>
+#include <ctype.h>
+#include <stdlib.h>
+
+#include <glib.h>
+#include <string.h>
+#include <stdio.h>
+
+#define OFONO_API_SUBJECT_TO_CHANGE
+#include <ofono/plugin.h>
+#include <ofono/modem.h>
+#include <ofono/log.h>
+
+static GSList *modem_list;
+
+static int create_rilmodem(const char *ril_type, int slot)
+{
+	struct ofono_modem *modem;
+	char dev_name[64];
+	int retval;
+
+	snprintf(dev_name, sizeof(dev_name), "ril_%d", slot);
+
+	modem = ofono_modem_create(dev_name, ril_type);
+	if (modem == NULL) {
+		DBG("ofono_modem_create failed for type %s", ril_type);
+		return -ENODEV;
+	}
+
+	modem_list = g_slist_prepend(modem_list, modem);
+
+	ofono_modem_set_integer(modem, "Slot", slot);
+
+	/* This causes driver->probe() to be called... */
+	retval = ofono_modem_register(modem);
+	if (retval != 0) {
+		ofono_error("%s: ofono_modem_register returned: %d",
+				__func__, retval);
+		return retval;
+	}
+
+	/*
+	 * kickstart the modem:
+	 * causes core modem code to call
+	 * - set_powered(TRUE) - which in turn
+	 *   calls driver->enable()
+	 *
+	 * - driver->pre_sim()
+	 *
+	 * Could also be done via:
+	 *
+	 * - a DBus call to SetProperties w/"Powered=TRUE" *1
+	 * - sim_state_watch ( handles SIM removal? LOCKED states? **2
+	 * - ofono_modem_set_powered()
+	 */
+	ofono_modem_reset(modem);
+
+	return 0;
+}
+
+static int detect_init(void)
+{
+	const char *ril_type;
+	const char *multi_sim;
+	int num_slots = 1;
+	int i;
+
+	ril_type = getenv("OFONO_RIL_DEVICE");
+	if (ril_type == NULL)
+		ril_type = "ril";
+
+	/* Check for multi-SIM support */
+	multi_sim = getenv("OFONO_RIL_NUM_SIM_SLOTS");
+	if (multi_sim != NULL && *multi_sim != '\0') {
+		int env_slots;
+		char *endp;
+
+		env_slots = (int) strtoul(multi_sim, &endp, 10);
+		if (*endp == '\0')
+			num_slots = env_slots;
+	}
+
+	ofono_info("RILDEV detected modem type %s, %d SIM slot(s)",
+			ril_type, num_slots);
+
+	for (i = 0; i < num_slots; ++i)
+		create_rilmodem(ril_type, i);
+
+	return 0;
+}
+
+static void detect_exit(void)
+{
+	GSList *list;
+
+	for (list = modem_list; list; list = list->next) {
+		struct ofono_modem *modem = list->data;
+
+		ofono_modem_remove(modem);
+	}
+
+	g_slist_free(modem_list);
+	modem_list = NULL;
+}
+
+OFONO_PLUGIN_DEFINE(rildev, "ril type detection", VERSION,
+		OFONO_PLUGIN_PRIORITY_DEFAULT, detect_init, detect_exit)