From bbf9034eaab39ad637ef9a3a1fd935d624dcdba8 Mon Sep 17 00:00:00 2001 From: Andreas Eversberg Date: Fri, 28 Oct 2011 03:55:37 +0200 Subject: gsm/sms: Rewrite of SMC process, extracted from OpenBSC The SMC process is used to transfer RP frames. It is now extracted from OpenBSC. It includes a real state machine now for easier debugging. Written-by: Andreas Eversberg Signed-off-by: Sylvain Munaut --- include/osmocom/gsm/Makefile.am | 2 +- include/osmocom/gsm/gsm0411_smc.h | 62 ++++ include/osmocom/gsm/protocol/gsm_04_11.h | 7 +- src/gsm/Makefile.am | 2 +- src/gsm/gsm0411_smc.c | 539 +++++++++++++++++++++++++++++++ 5 files changed, 607 insertions(+), 5 deletions(-) create mode 100644 include/osmocom/gsm/gsm0411_smc.h create mode 100644 src/gsm/gsm0411_smc.c diff --git a/include/osmocom/gsm/Makefile.am b/include/osmocom/gsm/Makefile.am index 3dbbad5f..49a2ec48 100644 --- a/include/osmocom/gsm/Makefile.am +++ b/include/osmocom/gsm/Makefile.am @@ -1,7 +1,7 @@ osmogsm_HEADERS = a5.h comp128.h gsm0808.h gsm48_ie.h mncc.h rxlev_stat.h \ gsm0480.h gsm48.h gsm_utils.h rsl.h tlv.h abis_nm.h \ sysinfo.h prim.h gsm0502.h lapd_core.h lapdm.h \ - gsm0411_utils.h + gsm0411_utils.h gsm0411_smc.h SUBDIRS = protocol diff --git a/include/osmocom/gsm/gsm0411_smc.h b/include/osmocom/gsm/gsm0411_smc.h new file mode 100644 index 00000000..e1508a2d --- /dev/null +++ b/include/osmocom/gsm/gsm0411_smc.h @@ -0,0 +1,62 @@ +#ifndef _GSM0411_SMC_H +#define _GSM0411_SMC_H + +#include + +#define GSM411_MMSMS_EST_REQ 0x310 +#define GSM411_MMSMS_EST_IND 0x312 +#define GSM411_MMSMS_EST_CNF 0x311 +#define GSM411_MMSMS_REL_REQ 0x320 +#define GSM411_MMSMS_REL_IND 0x322 +#define GSM411_MMSMS_DATA_REQ 0x330 +#define GSM411_MMSMS_DATA_IND 0x332 +#define GSM411_MMSMS_UNIT_DATA_REQ 0x340 +#define GSM411_MMSMS_UNIT_DATA_IND 0x342 +#define GSM411_MMSMS_ERR_IND 0x372 + +#define GSM411_MNSMS_ABORT_REQ 0x101 +#define GSM411_MNSMS_DATA_REQ 0x102 +#define GSM411_MNSMS_DATA_IND 0x103 +#define GSM411_MNSMS_EST_REQ 0x104 +#define GSM411_MNSMS_EST_IND 0x105 +#define GSM411_MNSMS_ERROR_IND 0x106 +#define GSM411_MNSMS_REL_REQ 0x107 + +struct gsm411_smc_inst { + int network; /* is this a MO (0) or MT (1) transfer */ + int (*mn_recv) (struct gsm411_smc_inst *inst, int msg_type, + struct msgb *msg); + int (*mm_send) (struct gsm411_smc_inst *inst, int msg_type, + struct msgb *msg, int cp_msg_type); + + enum gsm411_cp_state cp_state; + struct osmo_timer_list cp_timer; + struct msgb *cp_msg; /* store pending message */ + int cp_rel; /* store pending release */ + int cp_retx; /* retry counter */ + int cp_max_retr; /* maximum retry */ + int cp_tc1; /* timer value TC1* */ + +}; + +extern const struct value_string gsm411_cp_cause_strs[]; + +/* init a new instance */ +void gsm411_smc_init(struct gsm411_smc_inst *inst, int network, + int (*mn_recv) (struct gsm411_smc_inst *inst, int msg_type, + struct msgb *msg), + int (*mm_send) (struct gsm411_smc_inst *inst, int msg_type, + struct msgb *msg, int cp_msg_type)); + +/* clear instance */ +void gsm411_smc_clear(struct gsm411_smc_inst *inst); + +/* message from upper layer */ +int gsm411_smc_send(struct gsm411_smc_inst *inst, int msg_type, + struct msgb *msg); + +/* message from lower layer */ +int gsm411_smc_recv(struct gsm411_smc_inst *inst, int msg_type, + struct msgb *msg, int cp_msg_type); + +#endif /* _GSM0411_SMC_H */ diff --git a/include/osmocom/gsm/protocol/gsm_04_11.h b/include/osmocom/gsm/protocol/gsm_04_11.h index c6a2b193..905ea9cb 100644 --- a/include/osmocom/gsm/protocol/gsm_04_11.h +++ b/include/osmocom/gsm/protocol/gsm_04_11.h @@ -5,7 +5,7 @@ /* GSM TS 04.11 definitions */ -/* Chapter 5.2.3: SMC-CS states at the network side */ +/* Chapter 5.2.3: SMC-CS states at the user/network side */ enum gsm411_cp_state { GSM411_CPS_IDLE = 0, GSM411_CPS_MM_CONN_PENDING = 1, /* only MT ! */ @@ -13,11 +13,12 @@ enum gsm411_cp_state { GSM411_CPS_MM_ESTABLISHED = 3, }; -/* Chapter 6.2.2: SMR states at the network side */ +/* Chapter 6.2.2: SMR states at the user/network side */ enum gsm411_rp_state { GSM411_RPS_IDLE = 0, GSM411_RPS_WAIT_FOR_RP_ACK = 1, GSM411_RPS_WAIT_TO_TX_RP_ACK = 3, + GSM411_RPS_WAIT_FOR_RETRANS_T = 4, }; /* Chapter 8.1.2 (refers to GSM 04.07 Chapter 11.2.3.1.1 */ @@ -95,7 +96,7 @@ enum gsm411_rp_cause { #define GSM411_TMR_TRAM 30, 0 /* 25 < x < 35 seconds */ #define GSM411_TMR_TR2M 15, 0 /* 12 < x < 20 seconds */ -#define GSM411_TMR_TC1A 30, 0 +#define GSM411_TMR_TC1A 30 /* TR1M - 10 */ /* Chapter 8.2.1 */ struct gsm411_rp_hdr { diff --git a/src/gsm/Makefile.am b/src/gsm/Makefile.am index 114d20f7..bd062226 100644 --- a/src/gsm/Makefile.am +++ b/src/gsm/Makefile.am @@ -10,7 +10,7 @@ lib_LTLIBRARIES = libosmogsm.la libosmogsm_la_SOURCES = a5.c rxlev_stat.c tlv_parser.c comp128.c gsm_utils.c \ rsl.c gsm48.c gsm48_ie.c gsm0808.c sysinfo.c \ gprs_cipher_core.c gsm0480.c abis_nm.c gsm0502.c \ - gsm0411_utils.c \ + gsm0411_utils.c gsm0411_smc.c \ lapd_core.c lapdm.c libosmogsm_la_LDFLAGS = -version-info $(LIBVERSION) diff --git a/src/gsm/gsm0411_smc.c b/src/gsm/gsm0411_smc.c new file mode 100644 index 00000000..187d6e6d --- /dev/null +++ b/src/gsm/gsm0411_smc.c @@ -0,0 +1,539 @@ +/* Point-to-Point (PP) Short Message Service (SMS) + * Support on Mobile Radio Interface + * 3GPP TS 04.11 version 7.1.0 Release 1998 / ETSI TS 100 942 V7.1.0 */ + +/* (C) 2008 by Daniel Willmann + * (C) 2009 by Harald Welte + * (C) 2010 by Holger Hans Peter Freyther + * (C) 2010 by On-Waves + * (C) 2011 by Andreas Eversberg + * + * All Rights Reserved + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU Affero General Public License as published by + * the Free Software Foundation; either version 3 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 Affero General Public License for more details. + * + * You should have received a copy of the GNU Affero General Public License + * along with this program. If not, see . + * + */ + +/* Notes on msg: + * + * Messages from lower layer are freed by lower layer. + * + * Messages to upper layer are freed after upper layer call returns, so upper + * layer cannot use data after returning. Upper layer must not free the msg. + * + * This implies: Lower layer messages can be forwarded to upper layer. + * + * Upper layer messages are freed by lower layer, so they must not be freed + * after calling lower layer. + * + * + * Notes on release: + * + * Whenever the process returns to IDLE, the MM connection is released using + * MMSMS-REL-REQ. It is allowed to destroy this process while processing + * this message. + * + * There is expeption, if MMSMS-REL-IND is received from lower layer, the + * process returns to IDLE without sending MMSMS-REL-REQ. + * + */ + +#include +#include +#include +#include +#include + +#include +#include +#include + +static void cp_timer_expired(void *data); + +#define MAX_SMS_RETRY 2; + +/* init a new instance */ +void gsm411_smc_init(struct gsm411_smc_inst *inst, int network, + int (*mn_recv) (struct gsm411_smc_inst *inst, int msg_type, + struct msgb *msg), + int (*mm_send) (struct gsm411_smc_inst *inst, int msg_type, + struct msgb *msg, int cp_msg_type)) +{ + memset(inst, 0, sizeof(*inst)); + inst->network = network; + inst->cp_max_retr = MAX_SMS_RETRY; + inst->cp_tc1 = GSM411_TMR_TC1A / (inst->cp_max_retr + 1); + inst->cp_state = GSM411_CPS_IDLE; + inst->mn_recv = mn_recv; + inst->mm_send = mm_send; + + LOGP(DLSMS, LOGL_INFO, "New SMC instance created\n"); +} + +/* clear instance */ +void gsm411_smc_clear(struct gsm411_smc_inst *inst) +{ + LOGP(DLSMS, LOGL_INFO, "Clear SMC instance\n"); + + osmo_timer_del(&inst->cp_timer); + + /* free stored msg */ + if (inst->cp_msg) { + LOGP(DLSMS, LOGL_INFO, "Dropping pending message\n"); + msgb_free(inst->cp_msg); + inst->cp_msg = NULL; + } +} + +const char *smc_state_names[] = { + "IDLE", + "MM_CONN_PENDING", + "WAIT_CP_ACK", + "MM_ESTABLISHED", +}; + +const struct value_string gsm411_cp_cause_strs[] = { + { GSM411_CP_CAUSE_NET_FAIL, "Network Failure" }, + { GSM411_CP_CAUSE_CONGESTION, "Congestion" }, + { GSM411_CP_CAUSE_INV_TRANS_ID, "Invalid Transaction ID" }, + { GSM411_CP_CAUSE_SEMANT_INC_MSG, "Semantically Incorrect Message" }, + { GSM411_CP_CAUSE_INV_MAND_INF, "Invalid Mandatory Information" }, + { GSM411_CP_CAUSE_MSGTYPE_NOTEXIST, "Message Type doesn't exist" }, + { GSM411_CP_CAUSE_MSG_INCOMP_STATE, + "Message incompatible with protocol state" }, + { GSM411_CP_CAUSE_IE_NOTEXIST, "IE does not exist" }, + { GSM411_CP_CAUSE_PROTOCOL_ERR, "Protocol Error" }, + { 0, 0 } +}; + +static void new_cp_state(struct gsm411_smc_inst *inst, + enum gsm411_cp_state state) +{ + LOGP(DLSMS, LOGL_INFO, "New CP state %s -> %s\n", + smc_state_names[inst->cp_state], smc_state_names[state]); + inst->cp_state = state; +} + +static int gsm411_tx_cp_error(struct gsm411_smc_inst *inst, uint8_t cause) +{ + struct msgb *nmsg = gsm411_msgb_alloc(); + uint8_t *causep; + + LOGP(DLSMS, LOGL_NOTICE, "TX CP-ERROR, cause %d (%s)\n", cause, + get_value_string(gsm411_cp_cause_strs, cause)); + + causep = msgb_put(nmsg, 1); + *causep = cause; + + return inst->mm_send(inst, GSM411_MMSMS_DATA_REQ, nmsg, + GSM411_MT_CP_ERROR); +} + +/* etablish SMC connection */ +static int gsm411_mnsms_est_req(struct gsm411_smc_inst *inst, struct msgb *msg) +{ + struct msgb *nmsg; + + if (inst->cp_msg) { + LOGP(DLSMS, LOGL_FATAL, "EST REQ, but we already have an " + "cp_msg. This should never happen, please fix!\n"); + msgb_free(inst->cp_msg); + } + + inst->cp_msg = msg; + new_cp_state(inst, GSM411_CPS_MM_CONN_PENDING); + /* clear stored release flag */ + inst->cp_rel = 0; + /* send MMSMS_EST_REQ */ + nmsg = gsm411_msgb_alloc(); + return inst->mm_send(inst, GSM411_MMSMS_EST_REQ, nmsg, 0); +} + +static int gsm411_mmsms_send_msg(struct gsm411_smc_inst *inst) +{ + struct msgb *nmsg; + + LOGP(DLSMS, LOGL_INFO, "Send CP data\n"); + /* reset retry counter */ + if (inst->cp_state != GSM411_CPS_WAIT_CP_ACK) + inst->cp_retx = 0; + /* 5.2.3.1.2: enter MO-wait for CP-ACK */ + /* 5.2.3.2.3: enter MT-wait for CP-ACK */ + new_cp_state(inst, GSM411_CPS_WAIT_CP_ACK); + inst->cp_timer.data = inst; + inst->cp_timer.cb = cp_timer_expired; + /* 5.3.2.1: Set Timer TC1A */ + osmo_timer_schedule(&inst->cp_timer, inst->cp_tc1, 0); + /* clone cp_msg */ + nmsg = gsm411_msgb_alloc(); + memcpy(msgb_put(nmsg, inst->cp_msg->len), inst->cp_msg->data, + inst->cp_msg->len); + /* send MMSMS_DATA_REQ with CP-DATA */ + return inst->mm_send(inst, GSM411_MMSMS_DATA_REQ, nmsg, + GSM411_MT_CP_DATA); +} + +static int gsm411_mmsms_est_cnf(struct gsm411_smc_inst *inst, struct msgb *msg) +{ + if (!inst->cp_msg) { + LOGP(DLSMS, LOGL_FATAL, "EST CNF, but we have no cp_msg. This " + "should never happen, please fix!\n"); + return -EINVAL; + } + + return gsm411_mmsms_send_msg(inst); +} + +/* SMC TC1* is expired */ +static void cp_timer_expired(void *data) +{ + struct gsm411_smc_inst *inst = data; + struct msgb *nmsg; + + if (inst->cp_retx == inst->cp_max_retr) { + + LOGP(DLSMS, LOGL_INFO, "TC1* timeout, no more retries.\n"); + /* 5.3.2.1: enter idle state */ + new_cp_state(inst, GSM411_CPS_IDLE); + /* indicate error */ + nmsg = gsm411_msgb_alloc(); + inst->mn_recv(inst, GSM411_MNSMS_ERROR_IND, nmsg); + msgb_free(nmsg); + /* free pending stored msg */ + if (inst->cp_msg) { + msgb_free(inst->cp_msg); + inst->cp_msg = NULL; + } + /* release MM connection */ + nmsg = gsm411_msgb_alloc(); + inst->mm_send(inst, GSM411_MMSMS_REL_REQ, nmsg, 0); + return; + } + + LOGP(DLSMS, LOGL_INFO, "TC1* timeout, retrying...\n"); + inst->cp_retx++; + gsm411_mmsms_est_cnf(inst, NULL); +} + +static int gsm411_mmsms_cp_ack(struct gsm411_smc_inst *inst, struct msgb *msg) +{ + /* free stored msg */ + if (inst->cp_msg) { + msgb_free(inst->cp_msg); + inst->cp_msg = NULL; + } + + LOGP(DLSMS, LOGL_INFO, "Received CP-ACK\n"); + /* 5.3.2.1 enter MM Connection established */ + new_cp_state(inst, GSM411_CPS_MM_ESTABLISHED); + /* 5.3.2.1: Reset Timer TC1* */ + osmo_timer_del(&inst->cp_timer); + + /* pending release? */ + if (inst->cp_rel) { + struct msgb *nmsg; + + LOGP(DLSMS, LOGL_INFO, "We have pending release.\n"); + new_cp_state(inst, GSM411_CPS_IDLE); + /* release MM connection */ + nmsg = gsm411_msgb_alloc(); + return inst->mm_send(inst, GSM411_MMSMS_REL_REQ, nmsg, 0); + } + + return 0; +} + +static int gsm411_mmsms_cp_data(struct gsm411_smc_inst *inst, struct msgb *msg) +{ + struct msgb *nmsg; + int mt = GSM411_MNSMS_DATA_IND; + + LOGP(DLSMS, LOGL_INFO, "Received CP-DATA\n"); + /* 5.3.1 enter MM Connection established (if idle) */ + if (inst->cp_state == GSM411_CPS_IDLE) { + new_cp_state(inst, GSM411_CPS_MM_ESTABLISHED); + mt = GSM411_MNSMS_EST_IND; + /* clear stored release flag */ + inst->cp_rel = 0; + } + /* send MMSMS_DATA_REQ (CP ACK) */ + nmsg = gsm411_msgb_alloc(); + inst->mm_send(inst, GSM411_MMSMS_DATA_REQ, nmsg, GSM411_MT_CP_ACK); + /* indicate data */ + inst->mn_recv(inst, mt, msg); + + return 0; +} + +/* send CP DATA */ +static int gsm411_mnsms_data_req(struct gsm411_smc_inst *inst, struct msgb *msg) +{ + if (inst->cp_msg) { + LOGP(DLSMS, LOGL_FATAL, "DATA REQ, but we already have an " + "cp_msg. This should never happen, please fix!\n"); + msgb_free(inst->cp_msg); + } + + /* store and send */ + inst->cp_msg = msg; + return gsm411_mmsms_send_msg(inst); +} + +/* release SMC connection */ +static int gsm411_mnsms_rel_req(struct gsm411_smc_inst *inst, struct msgb *msg) +{ + struct msgb *nmsg; + + msgb_free(msg); + + /* discard silently */ + if (inst->cp_state == GSM411_CPS_IDLE) + return 0; + + /* store release, until established or released */ + if (inst->cp_state != GSM411_CPS_MM_ESTABLISHED) { + LOGP(DLSMS, LOGL_NOTICE, "Cannot release yet.\n"); + inst->cp_rel = 1; + return 0; + } + + /* free stored msg */ + if (inst->cp_msg) { + msgb_free(inst->cp_msg); + inst->cp_msg = NULL; + } + + new_cp_state(inst, GSM411_CPS_IDLE); + /* release MM connection */ + nmsg = gsm411_msgb_alloc(); + return inst->mm_send(inst, GSM411_MMSMS_REL_REQ, nmsg, 0); +} + +static int gsm411_mmsms_cp_error(struct gsm411_smc_inst *inst, struct msgb *msg) +{ + struct msgb *nmsg; + + /* free stored msg */ + if (inst->cp_msg) { + msgb_free(inst->cp_msg); + inst->cp_msg = NULL; + } + + LOGP(DLSMS, LOGL_INFO, "Received CP-ERROR\n"); + /* 5.3.4 enter idle */ + new_cp_state(inst, GSM411_CPS_IDLE); + /* indicate error */ + inst->mn_recv(inst, GSM411_MNSMS_ERROR_IND, msg); + /* release MM connection */ + nmsg = gsm411_msgb_alloc(); + return inst->mm_send(inst, GSM411_MMSMS_REL_REQ, nmsg, 0); +} + +static int gsm411_mmsms_rel_ind(struct gsm411_smc_inst *inst, struct msgb *msg) +{ + struct msgb *nmsg; + + /* free stored msg */ + if (inst->cp_msg) { + msgb_free(inst->cp_msg); + inst->cp_msg = NULL; + } + + LOGP(DLSMS, LOGL_INFO, "MM layer is released\n"); + /* 5.3.4 enter idle */ + new_cp_state(inst, GSM411_CPS_IDLE); + /* indicate error */ + nmsg = gsm411_msgb_alloc(); + inst->mn_recv(inst, GSM411_MNSMS_ERROR_IND, nmsg); + msgb_free(nmsg); + + return 0; +} + +/* abort SMC connection */ +static int gsm411_mnsms_abort_req(struct gsm411_smc_inst *inst, + struct msgb *msg) +{ + struct msgb *nmsg; + + /* free stored msg */ + if (inst->cp_msg) { + msgb_free(inst->cp_msg); + inst->cp_msg = NULL; + } + + /* 5.3.4 go idle */ + new_cp_state(inst, GSM411_CPS_IDLE); + /* send MMSMS_DATA_REQ with CP-ERROR */ + inst->mm_send(inst, GSM411_MMSMS_DATA_REQ, msg, GSM411_MT_CP_ERROR); + /* release MM connection */ + nmsg = gsm411_msgb_alloc(); + return inst->mm_send(inst, GSM411_MMSMS_REL_REQ, nmsg, 0); +} + +/* statefull handling for MNSMS SAP messages */ +static struct smcdownstate { + uint32_t states; + int type; + const char *name; + int (*rout) (struct gsm411_smc_inst *inst, + struct msgb *msg); +} smcdownstatelist[] = { + /* establish request */ + {SBIT(GSM411_CPS_IDLE), + GSM411_MNSMS_EST_REQ, + "MNSMS-EST-REQ", gsm411_mnsms_est_req}, + + /* release request */ + {ALL_STATES, + GSM411_MNSMS_REL_REQ, + "MNSMS-REL-REQ", gsm411_mnsms_rel_req}, + + /* data request */ + {SBIT(GSM411_CPS_MM_ESTABLISHED), + GSM411_MNSMS_DATA_REQ, + "MNSMS-DATA-REQ", gsm411_mnsms_data_req}, + + /* abort request */ + {ALL_STATES - SBIT(GSM411_CPS_IDLE), + GSM411_MNSMS_ABORT_REQ, + "MNSMS-ABORT-REQ", gsm411_mnsms_abort_req}, +}; + +#define SMCDOWNSLLEN \ + (sizeof(smcdownstatelist) / sizeof(struct smcdownstate)) + +/* message from upper layer */ +int gsm411_smc_send(struct gsm411_smc_inst *inst, int msg_type, + struct msgb *msg) +{ + int i, rc; + + /* find function for current state and message */ + for (i = 0; i < SMCDOWNSLLEN; i++) { + if ((msg_type == smcdownstatelist[i].type) + && (SBIT(inst->cp_state) & smcdownstatelist[i].states)) + break; + } + if (i == SMCDOWNSLLEN) { + LOGP(DLSMS, LOGL_NOTICE, "Message %u unhandled at this state " + "%s.\n", msg_type, smc_state_names[inst->cp_state]); + msgb_free(msg); + return 0; + } + + LOGP(DLSMS, LOGL_INFO, "Message %s received in state %s\n", + smcdownstatelist[i].name, smc_state_names[inst->cp_state]); + + rc = smcdownstatelist[i].rout(inst, msg); + + return rc; +} + +/* statefull handling for MMSMS SAP messages */ +static struct smcdatastate { + uint32_t states; + int type, cp_type; + const char *name; + int (*rout) (struct gsm411_smc_inst *inst, + struct msgb *msg); +} smcdatastatelist[] = { + /* establish confirm */ + {SBIT(GSM411_CPS_MM_CONN_PENDING), + GSM411_MMSMS_EST_CNF, 0, + "MMSMS-EST-CNF", gsm411_mmsms_est_cnf}, + + /* establish indication (CP DATA) */ + {SBIT(GSM411_CPS_IDLE), + GSM411_MMSMS_EST_IND, GSM411_MT_CP_DATA, + "MMSMS-EST-IND (CP DATA)", gsm411_mmsms_cp_data}, + + /* data indication (CP DATA) */ + {SBIT(GSM411_CPS_MM_ESTABLISHED), + GSM411_MMSMS_DATA_IND, GSM411_MT_CP_DATA, + "MMSMS-DATA-IND (CP DATA)", gsm411_mmsms_cp_data}, + + /* data indication (CP ACK) */ + {SBIT(GSM411_CPS_WAIT_CP_ACK), + GSM411_MMSMS_DATA_IND, GSM411_MT_CP_ACK, + "MMSMS-DATA-IND (CP ACK)", gsm411_mmsms_cp_ack}, + + /* data indication (CP ERROR) */ + {ALL_STATES, + GSM411_MMSMS_DATA_IND, GSM411_MT_CP_ERROR, + "MMSMS-DATA-IND (CP_ERROR)", gsm411_mmsms_cp_error}, + + /* release indication */ + {ALL_STATES - SBIT(GSM411_CPS_IDLE), + GSM411_MMSMS_REL_IND, 0, + "MMSMS-REL-IND", gsm411_mmsms_rel_ind}, + +}; + +#define SMCDATASLLEN \ + (sizeof(smcdatastatelist) / sizeof(struct smcdatastate)) + +/* message from lower layer + * WARNING: We must not free msg, since it will be performed by the + * lower layer. */ +int gsm411_smc_recv(struct gsm411_smc_inst *inst, int msg_type, + struct msgb *msg, int cp_msg_type) +{ + int i, rc; + + /* find function for current state and message */ + for (i = 0; i < SMCDATASLLEN; i++) { + /* state must machtch, MM message must match + * CP msg must match only in case of MMSMS_DATA_IND + */ + if ((msg_type == smcdatastatelist[i].type) + && (SBIT(inst->cp_state) & smcdatastatelist[i].states) + && (msg_type != GSM411_MMSMS_DATA_IND + || cp_msg_type == smcdatastatelist[i].cp_type)) + break; + } + if (i == SMCDATASLLEN) { + LOGP(DLSMS, LOGL_NOTICE, "Message 0x%x/%u unhandled at this " + "state %s.\n", msg_type, cp_msg_type, + smc_state_names[inst->cp_state]); + if (msg_type == GSM411_MMSMS_EST_IND + || msg_type == GSM411_MMSMS_DATA_IND) { + struct msgb *nmsg; + + LOGP(DLSMS, LOGL_NOTICE, "RX Unimplemented CP " + "msg_type: 0x%02x\n", msg_type); + /* 5.3.4 enter idle */ + new_cp_state(inst, GSM411_CPS_IDLE); + /* indicate error */ + gsm411_tx_cp_error(inst, + GSM411_CP_CAUSE_MSGTYPE_NOTEXIST); + /* send error indication to upper layer */ + nmsg = gsm411_msgb_alloc(); + inst->mn_recv(inst, GSM411_MNSMS_ERROR_IND, nmsg); + msgb_free(nmsg); + /* release MM connection */ + nmsg = gsm411_msgb_alloc(); + return inst->mm_send(inst, GSM411_MMSMS_REL_REQ, nmsg, + 0); + } + return 0; + } + + LOGP(DLSMS, LOGL_INFO, "Message %s received in state %s\n", + smcdatastatelist[i].name, smc_state_names[inst->cp_state]); + + rc = smcdatastatelist[i].rout(inst, msg); + + return rc; +} -- cgit v1.2.3