libosmocore/src/gsm/gsup_sms.c

/*
 * (C) 2018 by Vadim Yanitskiy <axilirator@gmail.com>
 *
 * 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, see <http://www.gnu.org/licenses/>.
 *
 */

#include <stdint.h>
#include <string.h>
#include <errno.h>

#include <osmocom/core/logging.h>
#include <osmocom/core/msgb.h>

#include <osmocom/gsm/gsup.h>
#include <osmocom/gsm/tlv.h>

/*! \addtogroup gsup
 *  @{
 *  \file gsup_sms.c
 *  SMS (Short Message Service) extensions for Osmocom GSUP.
 */

/*! Encode SM-RP-DA IE (see 7.6.8.1), Destination Address.
 * \param[out] msg      target message buffer (caller-allocated)
 * \param[in]  gsup_msg abstract GSUP message structure
 * \returns 0 in case of success, negative in case of error
 */
int osmo_gsup_sms_encode_sm_rp_da(struct msgb *msg,
	const struct osmo_gsup_message *gsup_msg)
{
	uint8_t *id_enc;

	switch (gsup_msg->sm_rp_da_type) {
	case OSMO_GSUP_SMS_SM_RP_ODA_IMSI:
	case OSMO_GSUP_SMS_SM_RP_ODA_MSISDN:
	case OSMO_GSUP_SMS_SM_RP_ODA_SMSC_ADDR:
		/* Prevent NULL-pointer (or empty) dereference */
		if (gsup_msg->sm_rp_da == NULL || gsup_msg->sm_rp_da_len == 0) {
			LOGP(DLGSUP, LOGL_ERROR, "Empty?!? SM-RP-DA ID "
				"(type=0x%02x)!\n", gsup_msg->sm_rp_da_type);
			return -EINVAL;
		}
		break;

	/* Special case for noSM-RP-DA */
	case OSMO_GSUP_SMS_SM_RP_ODA_NULL:
		break;

	case OSMO_GSUP_SMS_SM_RP_ODA_NONE:
	default:
		LOGP(DLGSUP, LOGL_ERROR, "Unexpected SM-RP-DA ID "
			"(type=0x%02x)!\n", gsup_msg->sm_rp_da_type);
		return -EINVAL;
	}

	/* SM-RP-DA tag | len | ... */
	msgb_tv_put(msg, OSMO_GSUP_SM_RP_DA_IE, gsup_msg->sm_rp_da_len + 1);
	msgb_v_put(msg, gsup_msg->sm_rp_da_type); /* ... | id_type */

	if (gsup_msg->sm_rp_da_type == OSMO_GSUP_SMS_SM_RP_ODA_NULL)
		return 0;

	/* ... | id_enc */
	id_enc = msgb_put(msg, gsup_msg->sm_rp_da_len);
	memcpy(id_enc, gsup_msg->sm_rp_da, gsup_msg->sm_rp_da_len);

	return 0;
}

/*! Decode SM-RP-DA IE (see 7.6.8.1), Destination Address.
 * \param[out] gsup_msg abstract GSUP message structure
 * \param[in]  data     pointer to the raw IE payload
 * \param[in]  data_len length of IE pointed by \ref data
 * \returns 0 in case of success, negative in case of error
 */
int osmo_gsup_sms_decode_sm_rp_da(struct osmo_gsup_message *gsup_msg,
	uint8_t *data, size_t data_len)
{
	uint8_t *ptr = data;
	uint8_t id_type;

	/* There should be at least id_type */
	if (data_len < 1) {
		LOGP(DLGSUP, LOGL_ERROR, "Corrupted SM-RP-DA IE "
			"(missing identity type)\n");
		return -EINVAL;
	}

	/* ... | id_type | id_enc (optional) */
	id_type = *ptr++;
	data_len--;

	/* Parse ID type */
	switch (id_type) {
	case OSMO_GSUP_SMS_SM_RP_ODA_IMSI:
	case OSMO_GSUP_SMS_SM_RP_ODA_MSISDN:
	case OSMO_GSUP_SMS_SM_RP_ODA_SMSC_ADDR:
		if (!data_len) {
			/* ID shall not be empty (if its type != NULL) */
			LOGP(DLGSUP, LOGL_ERROR, "Corrupted SM-RP-DA IE "
				"(missing encoded identity)\n");
			return -EINVAL;
		}

		gsup_msg->sm_rp_da_type = id_type;
		gsup_msg->sm_rp_da_len = data_len;
		gsup_msg->sm_rp_da = ptr;
		break;

	/* Special case for noSM-RP-DA */
	case OSMO_GSUP_SMS_SM_RP_ODA_NULL:
		if (data_len != 0) {
			LOGP(DLGSUP, LOGL_ERROR, "Unexpected SM-RP-DA ID, "
				"(id_len != 0) for noSM-RP-DA!\n");
			return -EINVAL;
		}

		gsup_msg->sm_rp_da_type = id_type;
		gsup_msg->sm_rp_da_len = 0;
		gsup_msg->sm_rp_da = NULL;
		break;

	case OSMO_GSUP_SMS_SM_RP_ODA_NONE:
	default:
		LOGP(DLGSUP, LOGL_ERROR, "Unexpected SM-RP-DA ID "
			"(type=0x%02x)!\n", id_type);
		return -EINVAL;
	}

	return 0;
}

/*! Encode SM-RP-OA IE (see 7.6.8.2), Originating Address.
 * \param[out] msg      target message buffer (caller-allocated)
 * \param[in]  gsup_msg abstract GSUP message structure
 * \returns 0 in case of success, negative in case of error
 */
int osmo_gsup_sms_encode_sm_rp_oa(struct msgb *msg,
	const struct osmo_gsup_message *gsup_msg)
{
	uint8_t *id_enc;

	switch (gsup_msg->sm_rp_oa_type) {
	case OSMO_GSUP_SMS_SM_RP_ODA_MSISDN:
	case OSMO_GSUP_SMS_SM_RP_ODA_SMSC_ADDR:
		/* Prevent NULL-pointer (or empty) dereference */
		if (gsup_msg->sm_rp_oa == NULL || gsup_msg->sm_rp_oa_len == 0) {
			LOGP(DLGSUP, LOGL_ERROR, "Empty?!? SM-RP-OA ID "
				"(type=0x%02x)!\n", gsup_msg->sm_rp_oa_type);
			return -EINVAL;
		}
		break;

	/* Special case for noSM-RP-OA */
	case OSMO_GSUP_SMS_SM_RP_ODA_NULL:
		break;

	case OSMO_GSUP_SMS_SM_RP_ODA_NONE:
	default:
		LOGP(DLGSUP, LOGL_ERROR, "Unexpected SM-RP-OA ID "
			"(type=0x%02x)!\n", gsup_msg->sm_rp_oa_type);
		return -EINVAL;
	}

	/* SM-RP-OA tag | len | ... */
	msgb_tv_put(msg, OSMO_GSUP_SM_RP_OA_IE, gsup_msg->sm_rp_oa_len + 1);
	msgb_v_put(msg, gsup_msg->sm_rp_oa_type); /* ... | id_type */

	if (gsup_msg->sm_rp_oa_type == OSMO_GSUP_SMS_SM_RP_ODA_NULL)
		return 0;

	/* ... | id_enc */
	id_enc = msgb_put(msg, gsup_msg->sm_rp_oa_len);
	memcpy(id_enc, gsup_msg->sm_rp_oa, gsup_msg->sm_rp_oa_len);

	return 0;
}

/*! Decode SM-RP-OA IE (see 7.6.8.2), Originating Address.
 * \param[out] gsup_msg abstract GSUP message structure
 * \param[in]  data     pointer to the raw IE payload
 * \param[in]  data_len length of IE pointed by \ref data
 * \returns 0 in case of success, negative in case of error
 */
int osmo_gsup_sms_decode_sm_rp_oa(struct osmo_gsup_message *gsup_msg,
	uint8_t *data, size_t data_len)
{
	uint8_t *ptr = data;
	uint8_t id_type;

	/* There should be at least id_type */
	if (data_len < 1) {
		LOGP(DLGSUP, LOGL_ERROR, "Corrupted SM-RP-OA IE "
			"(missing identity type)\n");
		return -EINVAL;
	}

	/* ... | id_type | id_enc (optional) */
	id_type = *ptr++;
	data_len--;

	/* Parse ID type */
	switch (id_type) {
	case OSMO_GSUP_SMS_SM_RP_ODA_IMSI:
	case OSMO_GSUP_SMS_SM_RP_ODA_MSISDN:
	case OSMO_GSUP_SMS_SM_RP_ODA_SMSC_ADDR:
		if (!data_len) {
			/* ID shall not be empty (if its type != NULL) */
			LOGP(DLGSUP, LOGL_ERROR, "Corrupted SM-RP-OA IE "
				"(missing encoded identity)\n");
			return -EINVAL;
		}

		gsup_msg->sm_rp_oa_type = id_type;
		gsup_msg->sm_rp_oa_len = data_len;
		gsup_msg->sm_rp_oa = ptr;
		break;

	/* Special case for noSM-RP-DA */
	case OSMO_GSUP_SMS_SM_RP_ODA_NULL:
		if (data_len != 0) {
			LOGP(DLGSUP, LOGL_ERROR, "Unexpected SM-RP-OA ID, "
				"(id_len != 0) for noSM-RP-DA!\n");
			return -EINVAL;
		}

		gsup_msg->sm_rp_oa_type = id_type;
		gsup_msg->sm_rp_oa_len = 0;
		gsup_msg->sm_rp_oa = NULL;
		break;

	case OSMO_GSUP_SMS_SM_RP_ODA_NONE:
	default:
		LOGP(DLGSUP, LOGL_ERROR, "Unexpected SM-RP-OA ID "
			"(type=0x%02x)!\n", id_type);
		return -EINVAL;
	}

	return 0;
}

/*! @} */