From 0bbf67dfd3d97c67a126e60de2c5648c88427981 Mon Sep 17 00:00:00 2001 From: Harald Welte Date: Mon, 1 Jan 2018 20:31:58 +0100 Subject: MNCC: Add MNCC to string dumper As MNCC is rather hard to debug (wireshark cannot trace UNIX domain sockets), let's add our own decoder that we can use from related debug log statements in the respective programs. Change-Id: I216aaf70868ba5f3860a60c4b2442957531a3011 --- include/osmocom/gsm/mncc.h | 9 + src/gsm/Makefile.am | 2 +- src/gsm/libosmogsm.map | 3 + src/gsm/mncc.c | 416 +++++++++++++++++++++++++++++++++++++++++++++ 4 files changed, 429 insertions(+), 1 deletion(-) create mode 100644 src/gsm/mncc.c diff --git a/include/osmocom/gsm/mncc.h b/include/osmocom/gsm/mncc.h index f2450d9c..5ca29863 100644 --- a/include/osmocom/gsm/mncc.h +++ b/include/osmocom/gsm/mncc.h @@ -82,3 +82,12 @@ enum { GSM_MNCC_BCAP_OTHER_ITC = 5, GSM_MNCC_BCAP_RESERVED = 7, }; + +struct msgb; +struct msgb *osmo_mncc_stringify(const uint8_t *msg, unsigned int len); + +void _osmo_mncc_log(int subsys, int level, const char *file, int line, const char *prefix, + const uint8_t *msg, unsigned int len); + +#define osmo_mncc_log(ss, level, prefix, msg, len) \ + _osmo_mncc_log(ss, level, __BASE_FILE__, __LINE__, prefix, msg, len); diff --git a/src/gsm/Makefile.am b/src/gsm/Makefile.am index 12f56db1..f85aba39 100644 --- a/src/gsm/Makefile.am +++ b/src/gsm/Makefile.am @@ -30,7 +30,7 @@ libgsmint_la_SOURCES = a5.c rxlev_stat.c tlv_parser.c comp128.c comp128v23.c \ milenage/aes-internal.c milenage/aes-internal-enc.c \ milenage/milenage.c gan.c ipa.c gsm0341.c apn.c \ gsup.c gprs_gea.c gsm0503_conv.c oap.c gsm0808_utils.c \ - gsm23003.c + gsm23003.c mncc.c libgsmint_la_LDFLAGS = -no-undefined libgsmint_la_LIBADD = $(top_builddir)/src/libosmocore.la diff --git a/src/gsm/libosmogsm.map b/src/gsm/libosmogsm.map index 985ec839..9a7073df 100644 --- a/src/gsm/libosmogsm.map +++ b/src/gsm/libosmogsm.map @@ -427,5 +427,8 @@ osmo_oap_decode; osmo_imsi_str_valid; osmo_msisdn_str_valid; +osmo_mncc_stringify; +_osmo_mncc_log; + local: *; }; diff --git a/src/gsm/mncc.c b/src/gsm/mncc.c new file mode 100644 index 00000000..fa4726cf --- /dev/null +++ b/src/gsm/mncc.c @@ -0,0 +1,416 @@ +/* mncc.c - utility routines for the MNCC API between the 04.08 + * message parsing and the actual Call Control logic */ + +/* (C) 2008-2017 by Harald Welte + * (C) 2009 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 . + * + */ + +#include "../config.h" + +#ifdef HAVE_SYS_SOCKET_H + +#include +#include +#include +#include +#include + +#include +#include +#include + +/* FIXME FIXME FIXME FIXME FIXME START */ +#define MNCC_SETUP_REQ 0x0101 +#define MNCC_SETUP_IND 0x0102 +#define MNCC_SETUP_RSP 0x0103 +#define MNCC_SETUP_CNF 0x0104 +#define MNCC_SETUP_COMPL_REQ 0x0105 +#define MNCC_SETUP_COMPL_IND 0x0106 +/* MNCC_REJ_* is perfomed via MNCC_REL_* */ +#define MNCC_CALL_CONF_IND 0x0107 +#define MNCC_CALL_PROC_REQ 0x0108 +#define MNCC_PROGRESS_REQ 0x0109 +#define MNCC_ALERT_REQ 0x010a +#define MNCC_ALERT_IND 0x010b +#define MNCC_NOTIFY_REQ 0x010c +#define MNCC_NOTIFY_IND 0x010d +#define MNCC_DISC_REQ 0x010e +#define MNCC_DISC_IND 0x010f +#define MNCC_REL_REQ 0x0110 +#define MNCC_REL_IND 0x0111 +#define MNCC_REL_CNF 0x0112 +#define MNCC_FACILITY_REQ 0x0113 +#define MNCC_FACILITY_IND 0x0114 +#define MNCC_START_DTMF_IND 0x0115 +#define MNCC_START_DTMF_RSP 0x0116 +#define MNCC_START_DTMF_REJ 0x0117 +#define MNCC_STOP_DTMF_IND 0x0118 +#define MNCC_STOP_DTMF_RSP 0x0119 +#define MNCC_MODIFY_REQ 0x011a +#define MNCC_MODIFY_IND 0x011b +#define MNCC_MODIFY_RSP 0x011c +#define MNCC_MODIFY_CNF 0x011d +#define MNCC_MODIFY_REJ 0x011e +#define MNCC_HOLD_IND 0x011f +#define MNCC_HOLD_CNF 0x0120 +#define MNCC_HOLD_REJ 0x0121 +#define MNCC_RETRIEVE_IND 0x0122 +#define MNCC_RETRIEVE_CNF 0x0123 +#define MNCC_RETRIEVE_REJ 0x0124 +#define MNCC_USERINFO_REQ 0x0125 +#define MNCC_USERINFO_IND 0x0126 +#define MNCC_REJ_REQ 0x0127 +#define MNCC_REJ_IND 0x0128 + +#define MNCC_BRIDGE 0x0200 +#define MNCC_FRAME_RECV 0x0201 +#define MNCC_FRAME_DROP 0x0202 +#define MNCC_LCHAN_MODIFY 0x0203 +#define MNCC_RTP_CREATE 0x0204 +#define MNCC_RTP_CONNECT 0x0205 +#define MNCC_RTP_FREE 0x0206 + +#define GSM_TCHF_FRAME 0x0300 +#define GSM_TCHF_FRAME_EFR 0x0301 +#define GSM_TCHH_FRAME 0x0302 +#define GSM_TCH_FRAME_AMR 0x0303 +#define GSM_BAD_FRAME 0x03ff + +#define MNCC_SOCKET_HELLO 0x0400 + +#define GSM_MAX_FACILITY 128 +#define GSM_MAX_SSVERSION 128 +#define GSM_MAX_USERUSER 128 + +#define MNCC_F_BEARER_CAP 0x0001 +#define MNCC_F_CALLED 0x0002 +#define MNCC_F_CALLING 0x0004 +#define MNCC_F_REDIRECTING 0x0008 +#define MNCC_F_CONNECTED 0x0010 +#define MNCC_F_CAUSE 0x0020 +#define MNCC_F_USERUSER 0x0040 +#define MNCC_F_PROGRESS 0x0080 +#define MNCC_F_EMERGENCY 0x0100 +#define MNCC_F_FACILITY 0x0200 +#define MNCC_F_SSVERSION 0x0400 +#define MNCC_F_CCCAP 0x0800 +#define MNCC_F_KEYPAD 0x1000 +#define MNCC_F_SIGNAL 0x2000 + +struct gsm_mncc { + /* context based information */ + uint32_t msg_type; + uint32_t callref; + + /* which fields are present */ + uint32_t fields; + + /* data derived informations (MNCC_F_ based) */ + struct gsm_mncc_bearer_cap bearer_cap; + struct gsm_mncc_number called; + struct gsm_mncc_number calling; + struct gsm_mncc_number redirecting; + struct gsm_mncc_number connected; + struct gsm_mncc_cause cause; + struct gsm_mncc_progress progress; + struct gsm_mncc_useruser useruser; + struct gsm_mncc_facility facility; + struct gsm_mncc_cccap cccap; + struct gsm_mncc_ssversion ssversion; + struct { + int sup; + int inv; + } clir; + int signal; + + /* data derived information, not MNCC_F based */ + int keypad; + int more; + int notify; /* 0..127 */ + int emergency; + char imsi[16]; + + unsigned char lchan_type; + unsigned char lchan_mode; +}; + +struct gsm_data_frame { + uint32_t msg_type; + uint32_t callref; + unsigned char data[0]; +}; + +#define MNCC_SOCK_VERSION 5 +struct gsm_mncc_hello { + uint32_t msg_type; + uint32_t version; + + /* send the sizes of the structs */ + uint32_t mncc_size; + uint32_t data_frame_size; + + /* send some offsets */ + uint32_t called_offset; + uint32_t signal_offset; + uint32_t emergency_offset; + uint32_t lchan_type_offset; +}; + +struct gsm_mncc_rtp { + uint32_t msg_type; + uint32_t callref; + uint32_t ip; + uint16_t port; + uint32_t payload_type; + uint32_t payload_msg_type; +}; + +struct gsm_mncc_bridge { + uint32_t msg_type; + uint32_t callref[2]; +}; + +/* FIXME FIXME FIXME FIXME FIXME END */ + +const struct value_string osmo_mncc_names[] = { + { MNCC_SETUP_REQ, "MNCC_SETUP_REQ" }, + { MNCC_SETUP_IND, "MNCC_SETUP_IND" }, + { MNCC_SETUP_RSP, "MNCC_SETUP_RSP" }, + { MNCC_SETUP_CNF, "MNCC_SETUP_CNF" }, + { MNCC_SETUP_COMPL_REQ, "MNCC_SETUP_COMPL_REQ" }, + { MNCC_SETUP_COMPL_IND, "MNCC_SETUP_COMPL_IND" }, + { MNCC_CALL_CONF_IND, "MNCC_CALL_CONF_IND" }, + { MNCC_CALL_PROC_REQ, "MNCC_CALL_PROC_REQ" }, + { MNCC_PROGRESS_REQ, "MNCC_PROGRESS_REQ" }, + { MNCC_ALERT_REQ, "MNCC_ALERT_REQ" }, + { MNCC_ALERT_IND, "MNCC_ALERT_IND" }, + { MNCC_NOTIFY_REQ, "MNCC_NOTIFY_REQ" }, + { MNCC_NOTIFY_IND, "MNCC_NOTIFY_IND" }, + { MNCC_DISC_REQ, "MNCC_DISC_REQ" }, + { MNCC_DISC_IND, "MNCC_DISC_IND" }, + { MNCC_REL_REQ, "MNCC_REL_REQ" }, + { MNCC_REL_IND, "MNCC_REL_IND" }, + { MNCC_REL_CNF, "MNCC_REL_CNF" }, + { MNCC_FACILITY_REQ, "MNCC_FACILITY_REQ" }, + { MNCC_FACILITY_IND, "MNCC_FACILITY_IND" }, + { MNCC_START_DTMF_IND, "MNCC_START_DTMF_IND" }, + { MNCC_START_DTMF_RSP, "MNCC_START_DTMF_RSP" }, + { MNCC_START_DTMF_REJ, "MNCC_START_DTMF_REJ" }, + { MNCC_STOP_DTMF_IND, "MNCC_STOP_DTMF_IND" }, + { MNCC_STOP_DTMF_RSP, "MNCC_STOP_DTMF_RSP" }, + { MNCC_MODIFY_REQ, "MNCC_MODIFY_REQ" }, + { MNCC_MODIFY_IND, "MNCC_MODIFY_IND" }, + { MNCC_MODIFY_RSP, "MNCC_MODIFY_RSP" }, + { MNCC_MODIFY_CNF, "MNCC_MODIFY_CNF" }, + { MNCC_MODIFY_REJ, "MNCC_MODIFY_REJ" }, + { MNCC_HOLD_IND, "MNCC_HOLD_IND" }, + { MNCC_HOLD_CNF, "MNCC_HOLD_CNF" }, + { MNCC_HOLD_REJ, "MNCC_HOLD_REJ" }, + { MNCC_RETRIEVE_IND, "MNCC_RETRIEVE_IND" }, + { MNCC_RETRIEVE_CNF, "MNCC_RETRIEVE_CNF" }, + { MNCC_RETRIEVE_REJ, "MNCC_RETRIEVE_REJ" }, + { MNCC_USERINFO_REQ, "MNCC_USERINFO_REQ" }, + { MNCC_USERINFO_IND, "MNCC_USERINFO_IND" }, + { MNCC_REJ_REQ, "MNCC_REJ_REQ" }, + { MNCC_REJ_IND, "MNCC_REJ_IND" }, + { MNCC_BRIDGE, "MNCC_BRIDGE" }, + { MNCC_FRAME_RECV, "MNCC_FRAME_RECV" }, + { MNCC_FRAME_DROP, "MNCC_FRAME_DROP" }, + { MNCC_LCHAN_MODIFY, "MNCC_LCHAN_MODIFY" }, + { MNCC_RTP_CREATE, "MNCC_RTP_CREATE" }, + { MNCC_RTP_CONNECT, "MNCC_RTP_CONNECT" }, + { MNCC_RTP_FREE, "MNCC_RTP_FREE" }, + { GSM_TCHF_FRAME, "GSM_TCHF_FRAME" }, + { GSM_TCHF_FRAME_EFR, "GSM_TCHF_FRAME_EFR" }, + { GSM_TCHH_FRAME, "GSM_TCHH_FRAME" }, + { GSM_TCH_FRAME_AMR, "GSM_TCH_FRAME_AMR" }, + { GSM_BAD_FRAME, "GSM_BAD_FRAME" }, + { MNCC_SOCKET_HELLO, "MNCC_SOCKET_HELLO" }, + { 0, NULL }, +}; + +static inline const char *osmo_mncc_name(uint32_t msg_type) { + return get_value_string(osmo_mncc_names, msg_type); +} + +static void mncc_dump_rtp(struct msgb *str, const uint8_t *msg, unsigned int len) +{ + const struct gsm_mncc_rtp *rtp = (const struct gsm_mncc_rtp *) msg; + struct in_addr ia; + if (len < sizeof(*rtp)) { + msgb_printf(str, "short MNCC RTP message (%u bytes)", len); + return; + } + + ia.s_addr = rtp->ip; + msgb_printf(str, "%s(ref=0x%08x, ip=%s, port=%u, pt=%u, pt_mt=%u)", + osmo_mncc_name(rtp->msg_type), rtp->callref, inet_ntoa(ia), + ntohs(rtp->port), rtp->payload_type, rtp->payload_msg_type); +} + +static void mncc_dump_data(struct msgb *str, const uint8_t *msg, unsigned int len) +{ + const struct gsm_data_frame *data = (const struct gsm_data_frame *) msg; + if (len < sizeof(*data)) { + msgb_printf(str, "short MNCC DATA message (%u bytes)", len); + return; + } + + msgb_printf(str, "%s(ref=0x%08x, data=%s)", osmo_mncc_name(data->msg_type), data->callref, + osmo_hexdump_nospc(data->data, len - sizeof(*data))); +} + +static void mncc_dump_hello(struct msgb *str, const uint8_t *msg, unsigned int len) +{ + const struct gsm_mncc_hello *hello = (const struct gsm_mncc_hello *) msg; + if (len < sizeof(*hello)) { + msgb_printf(str, "short MNCC HELLO message (%u bytes)", len); + return; + } + + msgb_printf(str, "%s(ver=%u, mncc_sz=%u, data_size=%u called_off=%u, signal_off=%u, " + "emerg_off=%u, lchan_t_off=%u)\n", osmo_mncc_name(hello->msg_type), + hello->version, hello->mncc_size, hello->data_frame_size, hello->called_offset, + hello->signal_offset, hello->emergency_offset, hello->lchan_type_offset); +} + +static void msg_dump_number(struct msgb *str, const char *pfx, const struct gsm_mncc_number *num) +{ + msgb_printf(str, "%s(%d,%d,%d,%d,%s)", pfx, num->type, num->plan, num->present, num->screen, + num->number); +} + +static void mncc_dump_bridge(struct msgb *str, const uint8_t *msg, unsigned int len) +{ + const struct gsm_mncc_bridge *bridge = (const struct gsm_mncc_bridge *)msg; + if (len < sizeof(*bridge)) { + msgb_printf(str, "short MNCC BRIDGE message (%u bytes)", len); + return; + } + + msgb_printf(str, "%s(call_a=0x%08x, call_b=0x%08x)", osmo_mncc_name(bridge->msg_type), + bridge->callref[0], bridge->callref[1]); +} + +static void mncc_dump_sign(struct msgb *str, const uint8_t *msg, unsigned int len) +{ + const struct gsm_mncc *sign = (const struct gsm_mncc *) msg; + if (len < sizeof(*sign)) { + msgb_printf(str, "short MNCC SIGN message (%u bytes)", len); + return; + } + + msgb_printf(str, "%s(ref=0x%08x, imsi=%s", osmo_mncc_name(sign->msg_type), sign->callref, + sign->imsi); + //if (sign->fields & MNCC_F_BEARER_CAP) + // msgb_printf(str, ", bcap=%s", osmo_hexdump_nospc()); + if (sign->fields & MNCC_F_CALLED) + msg_dump_number(str, ", called=", &sign->called); + if (sign->fields & MNCC_F_CALLING) + msg_dump_number(str, ", calling=", &sign->calling); + if (sign->fields & MNCC_F_REDIRECTING) + msg_dump_number(str, ", redirecting=", &sign->redirecting); + if (sign->fields & MNCC_F_CONNECTED) + msg_dump_number(str, ", connected=", &sign->connected); + if (sign->fields & MNCC_F_CAUSE) { + msgb_printf(str, ", cause=(%d,%d,%d,%d,%d,'%s')", sign->cause.location, + sign->cause.coding, sign->cause.rec, sign->cause.rec_val, + sign->cause.value, sign->cause.diag_len ? sign->cause.diag : ""); + } + if (sign->fields & MNCC_F_USERUSER) { + msgb_printf(str, ", useruser=(%u, '%s')", sign->useruser.proto, + sign->useruser.info); + } + if (sign->fields & MNCC_F_PROGRESS) { + msgb_printf(str, ", progress=(%d, %d, %d)", sign->progress.coding, + sign->progress.location, sign->progress.descr); + } + if (sign->fields & MNCC_F_EMERGENCY) + msgb_printf(str, ", emergency=%d", sign->emergency); + if (sign->fields & MNCC_F_FACILITY) + msgb_printf(str, ", facility='%s'", sign->facility.info); + if (sign->fields & MNCC_F_SSVERSION) + msgb_printf(str, ", ssversion='%s'", sign->ssversion.info); + if (sign->fields & MNCC_F_CCCAP) + msgb_printf(str, ", cccap=(%d, %d)", sign->cccap.dtmf, sign->cccap.pcp); + if (sign->fields & MNCC_F_KEYPAD) + msgb_printf(str, ", keypad=%d", sign->keypad); + if (sign->fields & MNCC_F_SIGNAL) + msgb_printf(str, ", signal=%d", sign->signal); + + msgb_printf(str, ", clir.sup=%d, clir.inv=%d, more=%d, notify=%d)", sign->clir.sup, + sign->clir.inv, sign->more, sign->notify); + /* lchan_type/lchan_mode? */ +} + + +struct msgb *osmo_mncc_stringify(const uint8_t *msg, unsigned int len) +{ + uint32_t msg_type; + struct msgb *str = msgb_alloc(2048, __func__); + + OSMO_ASSERT(str); + + if (len <= sizeof(msg_type)) { + msgb_printf(str, "short MNCC message (%d bytes)", len); + return NULL; + } + + msg_type = *(const uint32_t *)msg; + switch (msg_type) { + case MNCC_RTP_CREATE: + case MNCC_RTP_CONNECT: + case MNCC_RTP_FREE: + mncc_dump_rtp(str, msg, len); + break; + case GSM_TCHF_FRAME: + case GSM_TCHF_FRAME_EFR: + case GSM_TCHH_FRAME: + case GSM_TCH_FRAME_AMR: + case GSM_BAD_FRAME: + mncc_dump_data(str, msg, len); + break; + case MNCC_SOCKET_HELLO: + mncc_dump_hello(str, msg, len); + break; + case MNCC_BRIDGE: + mncc_dump_bridge(str, msg, len); + break; + default: + mncc_dump_sign(str, msg, len); + break; + } + return str; +} + +void _osmo_mncc_log(int ss, int level, const char *file, int line, const char *prefix, + const uint8_t *msg, unsigned int len) +{ + struct msgb *str; + if (!log_check_level(ss, level)) + return; + + str = osmo_mncc_stringify(msg, len); + if (!str) + return; + + logp2(ss, level, file, line, 0, "%s%s\n", prefix, str->data); + msgb_free(str); +} + +#endif /* HAVE_SYS_SOCKET_H */ -- cgit v1.2.3