cdma-sms: Add CDMA SMS Support

---
  Makefile.am    |    2 +-
  src/cdma-sms.c |  335 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++
  src/ofono.h    |    3 +
  3 files changed, 339 insertions(+), 1 deletions(-)

create mode 100644 src/cdma-sms.c

Makefile.am +1 -1

index e85f522..61168ed 100644
@@ -320,7 +320,7 @@ src_ofonod_SOURCES = $(gdbus_sources) $(builtin_sources) src/ofono.ver \
  			src/nettime.c src/stkagent.c src/stkagent.h \
  			src/simfs.c src/simfs.h src/audio-settings.c \
  			src/smsagent.c src/smsagent.h src/ctm.c \
-			src/cdma-smsutil.c
+			src/cdma-sms.c src/cdma-smsutil.c
 
  src_ofonod_LDADD = $(builtin_libadd) @GLIB_LIBS@ @DBUS_LIBS@ @CAPNG_LIBS@ -ldl
 

src/cdma-sms.c new file +335 -0

new file mode 100644
index 0000000..005262e
@@ -0,0 +1,335 @@
+/*
+ *
+ *  oFono - Open Source Telephony
+ *
+ *  Copyright (C) 2010  Nokia Corporation. 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 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<string.h>
+#include<stdio.h>
+#include<errno.h>
+
+#include<glib.h>
+#include<gdbus.h>
+#include<sys/time.h>
+
+#include "ofono.h"
+
+#include "cdma-smsutil.h"
+
+static GSList *g_drivers;
+
+struct ofono_cdma_sms {
+	const struct ofono_cdma_sms_driver *driver;
+	void *driver_data;
+	struct ofono_atom *atom;
+};
+
+static GDBusMethodTable cdma_sms_manager_methods[] = {
+	/* TODO */
+	{ }
+};
+
+static GDBusSignalTable cdma_sms_manager_signals[] = {
+	{ "IncomingMessage",	"sa{sv}"	},
+	/* TODO */
+	{ }
+};
+
+static void cdma_dispatch_text_message(struct ofono_cdma_sms *cdma_sms,
+					const char *message,
+					const char *oaddr)
+{
+	const char *path = __ofono_atom_get_path(cdma_sms->atom);
+	DBusConnection *conn = ofono_dbus_get_connection();
+	DBusMessage *signal;
+	DBusMessageIter iter;
+	DBusMessageIter dict;
+	const char *signal_name;
+
+	/* TODO: Support ImmediateMessage */
+	signal_name = "IncomingMessage";
+
+	signal = dbus_message_new_signal(path,
+					OFONO_CDMA_MESSAGE_MANAGER_INTERFACE,
+					signal_name);
+	if (signal == NULL)
+		return;
+
+	dbus_message_iter_init_append(signal,&iter);
+
+	dbus_message_iter_append_basic(&iter, DBUS_TYPE_STRING,&(message));
+
+	dbus_message_iter_open_container(&iter, DBUS_TYPE_ARRAY,
+					OFONO_PROPERTIES_ARRAY_SIGNATURE,
+					&dict);
+
+	ofono_dbus_dict_append(&dict, "Sender", DBUS_TYPE_STRING,&oaddr);
+
+	/* TODO: Other properties not supported yet */
+
+	dbus_message_iter_close_container(&iter,&dict);
+
+	g_dbus_send_message(conn, signal);
+
+	/*TODO: Add the message to history*/
+}
+
+static void ofono_cdma_sms_process_wmt_deliver(struct ofono_cdma_sms *cdma_sms,
+						struct cdma_sms *incoming)
+{
+	char *message;
+	char *oaddr;
+
+	message = cdma_sms_decode_text(&incoming->p2p_msg.bearer_data.ud);
+	if (message == NULL)
+		return;
+
+	oaddr = cdma_sms_address_to_string(&incoming->p2p_msg.oaddr);
+	if (oaddr == NULL) {
+		g_free(message);
+		return;
+	}
+
+	cdma_dispatch_text_message(cdma_sms, message, oaddr);
+
+	g_free(message);
+	g_free(oaddr);
+}
+
+static void ofono_cdma_sms_process_wmt(struct ofono_cdma_sms *cdma_sms,
+					struct cdma_sms *incoming)
+{
+	if (!check_bitmap(incoming->p2p_msg.bearer_data.subparam_bitmap,
+				CDMA_SMS_SUBPARAM_ID_MESSAGE_ID))
+		return;
+
+	/* TODO: Add duplicate detection support */
+
+	switch (incoming->p2p_msg.bearer_data.id.msg_type) {
+	case CDMA_SMS_RESERVED:
+		break;
+	case CDMA_SMS_DELIVER:
+		ofono_cdma_sms_process_wmt_deliver(cdma_sms, incoming);
+		break;
+	case CDMA_SMS_SUBMIT:
+	case CDMA_SMS_CANCEL:
+	case CDMA_SMS_DELIVER_ACK:
+	case CDMA_SMS_USER_ACK:
+	case CDMA_SMS_READ_ACK:
+		/* TODO */
+		break;
+	}
+}
+
+static void ofono_cdma_sms_process_p2p(struct ofono_cdma_sms *cdma_sms,
+					struct cdma_sms *incoming)
+{
+	gboolean ts_exist, oaddr_exist;
+
+	ts_exist = check_bitmap(incoming->p2p_msg.bearer_data.subparam_bitmap,
+				CDMA_SMS_PARAM_ID_TELESERVICE_IDENTIFIER);
+	oaddr_exist = check_bitmap(incoming->p2p_msg.param_bitmap,
+				CDMA_SMS_PARAM_ID_ORIGINATING_ADDRESS);
+
+	/*
+	 * Check validity of incoming message, per Table 3.4.2.1-1 of
+	 * 3GPP2 C.S0015-B v2.0.
+	 */
+	if (!ts_exist || !oaddr_exist)
+		return;
+
+	switch (incoming->p2p_msg.teleservice_id) {
+	case TELESERVICE_CMT91:
+	case TELESERVICE_WPT:
+		break; /* TODO: Not supported yet */
+	case TELESERVICE_WMT:
+		ofono_cdma_sms_process_wmt(cdma_sms, incoming);
+		break;
+	case TELESERVICE_VMN:
+	case TELESERVICE_WAP:
+	case TELESERVICE_WEMT:
+	case TELESERVICE_SCPT:
+	case TELESERVICE_CATPT:
+		break; /* TODO: Not supported yet */
+	}
+}
+
+void ofono_cdma_sms_deliver_notify(struct ofono_cdma_sms *cdma_sms,
+					unsigned char *pdu, int pdu_len)
+{
+	static struct cdma_sms s;
+
+	DBG("pdu len %d", pdu_len);
+
+	memset(&s, 0, sizeof(struct cdma_sms));
+
+	if (!cdma_sms_decode(pdu, pdu_len,&s))
+		return;
+
+	switch (s.type) {
+	case CDMA_SMS_P2P:
+		ofono_cdma_sms_process_p2p(cdma_sms,&s);
+		break;
+	case CDMA_SMS_BCAST:
+	case CDMA_SMS_ACK:
+		/*
+		 * TODO: Support SMS Broadcast Message and SMS
+		 * Acknowledge Message.
+		 */
+		break;
+	}
+}
+
+int ofono_cdma_sms_driver_register(const struct ofono_cdma_sms_driver *d)
+{
+	DBG("driver: %p, name: %s", d, d->name);
+
+	if (d->probe == NULL)
+		return -EINVAL;
+
+	g_drivers = g_slist_prepend(g_drivers, (void *)d);
+
+	return 0;
+}
+
+void ofono_cdma_sms_driver_unregister(const struct ofono_cdma_sms_driver *d)
+{
+	DBG("driver: %p, name: %s", d, d->name);
+
+	g_drivers = g_slist_remove(g_drivers, (void *)d);
+}
+
+static void cdma_sms_unregister(struct ofono_atom *atom)
+{
+	DBusConnection *conn = ofono_dbus_get_connection();
+	struct ofono_modem *modem = __ofono_atom_get_modem(atom);
+	const char *path = __ofono_atom_get_path(atom);
+
+	g_dbus_unregister_interface(conn, path,
+					OFONO_CDMA_MESSAGE_MANAGER_INTERFACE);
+
+	ofono_modem_remove_interface(modem,
+					OFONO_CDMA_MESSAGE_MANAGER_INTERFACE);
+}
+
+static void cdma_sms_remove(struct ofono_atom *atom)
+{
+	struct ofono_cdma_sms *cdma_sms = __ofono_atom_get_data(atom);
+
+	DBG("atom: %p", atom);
+
+	if (cdma_sms == NULL)
+		return;
+
+	if (cdma_sms->driver&&  cdma_sms->driver->remove)
+		cdma_sms->driver->remove(cdma_sms);
+
+	g_free(cdma_sms);
+}
+
+/*
+ * Create a CDMA SMS driver
+ *
+ * This creates a CDMA SMS driver that is hung off a @modem
+ * object. However, for the driver to be used by the system, it has to
+ * be registered with the oFono core using ofono_sms_register().
+ *
+ * This is done once the modem driver determines that SMS is properly
+ * supported by the hardware.
+ */
+struct ofono_cdma_sms *ofono_cdma_sms_create(struct ofono_modem *modem,
+						unsigned int vendor,
+						const char *driver,
+						void *data)
+{
+	struct ofono_cdma_sms *cdma_sms;
+	GSList *l;
+
+	if (driver == NULL)
+		return NULL;
+
+	cdma_sms = g_try_new0(struct ofono_cdma_sms, 1);
+	if (cdma_sms == NULL)
+		return NULL;
+
+	cdma_sms->atom = __ofono_modem_add_atom(modem,
+						OFONO_ATOM_TYPE_CDMA_SMS,
+						cdma_sms_remove, cdma_sms);
+
+	for (l = g_drivers; l; l = l->next) {
+		const struct ofono_cdma_sms_driver *drv = l->data;
+
+		if (g_strcmp0(drv->name, driver))
+			continue;
+
+		if (drv->probe(cdma_sms, vendor, data)<  0)
+			continue;
+
+		cdma_sms->driver = drv;
+		break;
+	}
+
+	return cdma_sms;
+}
+
+/*
+ * Indicate oFono that a CDMA SMS driver is ready for operation
+ *
+ * This is called after ofono_cdma_sms_create() was done and the modem
+ * driver determined that a modem supports SMS correctly. Once this
+ * call succeeds, the D-BUS interface for SMS goes live.
+ */
+void ofono_cdma_sms_register(struct ofono_cdma_sms *cdma_sms)
+{
+	DBusConnection *conn = ofono_dbus_get_connection();
+	struct ofono_modem *modem = __ofono_atom_get_modem(cdma_sms->atom);
+	const char *path = __ofono_atom_get_path(cdma_sms->atom);
+
+	if (!g_dbus_register_interface(conn, path,
+					OFONO_CDMA_MESSAGE_MANAGER_INTERFACE,
+					cdma_sms_manager_methods,
+					cdma_sms_manager_signals,
+					NULL, cdma_sms, NULL)) {
+		ofono_error("Could not create %s interface",
+				OFONO_CDMA_MESSAGE_MANAGER_INTERFACE);
+		return;
+	}
+
+	ofono_modem_add_interface(modem, OFONO_CDMA_MESSAGE_MANAGER_INTERFACE);
+
+	__ofono_atom_register(cdma_sms->atom, cdma_sms_unregister);
+}
+
+void ofono_cdma_sms_remove(struct ofono_cdma_sms *cdma_sms)
+{
+	__ofono_atom_free(cdma_sms->atom);
+}
+
+void ofono_cdma_sms_set_data(struct ofono_cdma_sms *cdma_sms, void *data)
+{
+	cdma_sms->driver_data = data;
+}
+
+void *ofono_cdma_sms_get_data(struct ofono_cdma_sms *cdma_sms)
+{
+	return cdma_sms->driver_data;
+}

src/ofono.h +1 -0

index 792134b..422fa8a 100644
@@ -126,6 +126,7 @@ enum ofono_atom_type {
  	OFONO_ATOM_TYPE_STK = 20,
  	OFONO_ATOM_TYPE_NETTIME = 21,
  	OFONO_ATOM_TYPE_CTM = 22,
+	OFONO_ATOM_TYPE_CDMA_SMS = 23,
  };
 
  enum ofono_atom_watch_condition {