From 294d27e78680d497da22e3a8ad679f50d1ba29e5 Mon Sep 17 00:00:00 2001

From: Andrzej Zaborowski <balrog@zabor.org>
Date: Wed, 11 Jul 2007 16:11:10 +0200
Subject: [PATCH] SMS support in gsmd and in libgsmd.

This adds the proper support for sms related calls in libgsmd and their
implementation in gsmd.

I assumed that conversion between data coding schemes is to be done on the
client side because the {packing,unpacking}* calls were exported.  TEXT mode
support is non-functional, but the code only has to be filled in the right
places to make it work, if it is ever needed.

I had been lucky to be able to test with the different kinds of messages with
exotic formats because I just got a bunch of network messages today (urging to
top-up the credit).

I tried to not modify the libgsmd api, although I would prefer to have a
totally different api, possibly with synchronous calls that just return the
result of an operation, for a exmaple a whole list of messages, rather than the
client waiting for an unknown number of events each with one message.


git-svn-id: http://svn.openmoko.org/trunk/src/target/gsm@2710 99fdad57-331a-0410-800a-d7fa5415bdb3

1 files changed, 259 insertions, 0 deletions

diff --git a/src/gsmd/sms_pdu.c b/src/gsmd/sms_pdu.c
new file mode 100644
index 0000000..1ec3202
--- /dev/null
+++ b/src/gsmd/sms_pdu.c
@@ -0,0 +1,259 @@
+/* Convert raw PDUs to and from gsmd format.
+ *
+ * Copyright (C) 2007 OpenMoko, Inc.
+ * Written by Andrzej Zaborowski <andrew@openedhand.com>
+ *
+ * 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., 59 Temple Place, Suite 330, Boston,
+ * MA 02111-1307 USA
+ */
+
+#include <stdio.h>
+#include <string.h>
+
+#include "gsmd.h"
+
+#include <gsmd/gsmd.h>
+#include <gsmd/usock.h>
+
+static int sms_number_bytelen(u_int8_t type, u_int8_t len)
+{
+	switch (type & __GSMD_TOA_TON_MASK) {
+	case GSMD_TOA_TON_ALPHANUMERIC:
+		return (len + 1) >> 1;
+	default:
+		return (len + 1) >> 1;
+	}
+}
+
+static int sms_data_bytelen(u_int8_t data_coding_scheme, u_int8_t len)
+{
+	switch (data_coding_scheme) {	/* Get length in bytes */
+	case ALPHABET_DEFAULT:
+		return (len * 7 + 7) >> 3;
+	case ALPHABET_8BIT:
+		return len;
+	case ALPHABET_UCS2:
+		return len * 2;
+	}
+	return 0;
+}
+
+static int sms_address2ascii(struct gsmd_addr *dst, u_int8_t *src)
+{
+	int i;
+
+	if (src[0] > GSMD_ADDR_MAXLEN)
+		return 1;
+
+	/* The Type-of-address field */
+	dst->type = src[1];
+
+	switch (dst->type & __GSMD_TOA_TON_MASK) {
+	case GSMD_TOA_TON_ALPHANUMERIC:
+		for (i = 0; ((i * 7 + 3) >> 2) < src[0]; i ++)
+			dst->number[i] =
+				((src[2 + ((i * 7 + 7) >> 3)] <<
+				  (7 - ((i * 7 + 7) & 7))) |
+				 (src[2 + ((i * 7) >> 3)] >>
+				  ((i * 7) & 7))) & 0x7f;
+		break;
+	default:
+		for (i = 0; i < src[0]; i ++)
+			dst->number[i] = '0' +
+				((src[2 + (i >> 1)] >> ((i << 2) & 4)) & 0xf);
+	}
+	dst->number[i] = 0;
+
+	return 0;
+}
+
+int sms_pdu_to_msg(struct gsmd_sms_list *dst,
+		u_int8_t *src, int pdulen, int len)
+{
+	int i, vpf;
+	if (len < 1 || len < 1 + src[0] + pdulen || pdulen < 1)
+		return 1;
+
+	/* Skip SMSC number and its Type-of-address */
+	len -= 1 + src[0];
+	src += 1 + src[0];
+
+	/* TP-UDHI */
+	dst->payload.has_header = !!(src[0] & GSMD_SMS_TP_UDHI_WITH_HEADER);
+
+	/* TP-VPF */
+	vpf = (src[0] >> 3) & 3;
+
+	/* TP-MTI */
+	switch (src[0] & 3) {
+	case GSMD_SMS_TP_MTI_DELIVER:
+		if (len < 3)
+			return 1;
+		i = sms_number_bytelen(src[2], src[1]);
+		if (len < 13 + i)
+			return 1;
+
+		if (sms_address2ascii(&dst->addr, src + 1))
+			return 1;
+
+		len -= 3 + i;
+		src += 3 + i;
+
+		/* TP-DCS */
+		switch (src[1] >> 4) {
+		case 0x0 ... 3:	/* General Data Coding indication */
+		case 0xc:	/* Message Waiting indication: Discard */
+			/* FIXME: support compressed data */
+			dst->payload.coding_scheme = src[1] & 0xc;
+			break;
+		case 0xd:	/* Message Waiting indication: Store */
+			dst->payload.coding_scheme = ALPHABET_DEFAULT;
+			break;
+		case 0xe:	/* Message Waiting indication: Store */
+			dst->payload.coding_scheme = ALPHABET_UCS2;
+			break;
+		case 0xf:	/* Data coding/message class */
+			dst->payload.coding_scheme = (src[1] & 4) ?
+				ALPHABET_8BIT : ALPHABET_DEFAULT;
+			break;
+		default:
+			return 1;
+		}
+
+		/* TP-SCTS */
+		memcpy(dst->time_stamp, src + 2, 7);
+
+		/* Skip TP-PID */
+		len -= 9;
+		src += 9;
+		break;
+	case GSMD_SMS_TP_MTI_SUBMIT:
+		if (len < 4)
+			return 1;
+		i = sms_number_bytelen(src[3], src[2]);
+		if (len < 8 + i)
+			return 1;
+
+		if (sms_address2ascii(&dst->addr, src + 2))
+			return 1;
+
+		len -= 4 + i;
+		src += 4 + i;
+
+		/* TP-DCS */
+		switch (src[1] >> 4) {
+		case 0x0 ... 3:	/* General Data Coding indication */
+		case 0xc:	/* Message Waiting indication: Discard */
+			/* FIXME: compressed data */
+			dst->payload.coding_scheme = src[1] & 0xc;
+			break;
+		case 0xd:	/* Message Waiting indication: Store */
+			dst->payload.coding_scheme = ALPHABET_DEFAULT;
+			break;
+		case 0xe:	/* Message Waiting indication: Store */
+			dst->payload.coding_scheme = ALPHABET_UCS2;
+			break;
+		case 0xf:	/* Data coding/message class */
+			dst->payload.coding_scheme = (src[1] & 4) ?
+				ALPHABET_8BIT : ALPHABET_DEFAULT;
+			break;
+		default:
+			return 1;
+		}
+
+		/* Skip TP-PID and TP-Validity-Period */
+		len -= vpf ? 3 : 2;
+		src += vpf ? 3 : 2;
+
+		memset(dst->time_stamp, 0, 7);
+		break;
+	default:
+		/* Unknown PDU type */
+		return 1;
+	}
+
+	/* TP-UDL */
+	dst->payload.length = src[0];
+	i = sms_data_bytelen(dst->payload.coding_scheme, src[0]);
+
+	/* TP-UD */
+	if (len < 1 + i || i > GSMD_SMS_DATA_MAXLEN)
+		return 1;
+	memcpy(dst->payload.data, src + 1, i);
+	dst->payload.data[i] = 0;
+
+	return 0;
+}
+
+/* Refer to GSM 03.40 subclause 9.2.3.3, for SMS-SUBMIT */
+int sms_pdu_make_smssubmit(char *dest, struct gsmd_sms_submit *src)
+{
+	/* FIXME: ALPHANUMERIC encoded addresses can be longer than 13B */
+	u_int8_t header[15 + GSMD_ADDR_MAXLEN];
+	int pos = 0, i, len;
+
+	/* SMSC Length octet.  If omitted or zero, use SMSC stored in the
+	 * phone.  One some phones this can/has to be omitted.  */
+	header[pos ++] = 0x00;
+
+	header[pos ++] =
+		GSMD_SMS_TP_MTI_SUBMIT |
+		(0 << 2) |		/* Reject Duplicates: 0 */
+		GSMD_SMS_TP_VPF_NOT_PRESENT |
+		GSMD_SMS_TP_SRR_NOT_REQUEST |
+		(src->payload.has_header ? GSMD_SMS_TP_UDHI_WITH_HEADER :
+		 GSMD_SMS_TP_UDHI_NO_HEADER) |
+		GSMD_SMS_TP_RP_NOT_SET;
+
+	/* TP-Message-Reference - 00 lets the phone set the number itself */
+	header[pos ++] = 0x00;
+
+	header[pos ++] = strlen(src->addr.number);
+	header[pos ++] = src->addr.type;
+	for (i = 0; src->addr.number[i]; i ++) {
+		header[pos] = src->addr.number[i ++] - '0';
+		if (src->addr.number[i])
+			header[pos ++] |= (src->addr.number[i] - '0') << 4;
+		else {
+			header[pos ++] |= 0xf0;
+			break;
+		}
+	}
+
+	/* TP-Protocol-Identifier - 00 means implicit */
+	header[pos ++] = 0x00;
+
+	/* TP-Data-Coding-Scheme */
+	header[pos ++] = src->payload.coding_scheme;
+
+	/* TP-Validity-Period, if present, would go here */
+
+	header[pos ++] = src->payload.length;
+	len = sms_data_bytelen(src->payload.coding_scheme,
+			src->payload.length);
+
+	if (dest) {
+		for (i = 0; i < pos; i ++) {
+			sprintf(dest, "%02X", header[i]);
+			dest += 2;
+		}
+		for (i = 0; i < len; i ++) {
+			sprintf(dest, "%02X", src->payload.data[i]);
+			dest += 2;
+		}
+	}
+
+	return pos + len;
+}