blob: 429c72de54a5862847e97f5f1e029357b01c3b2f [file] [log] [blame]
Holger Hans Peter Freytherdaa653f2010-10-11 07:56:06 +02001/*
2 * (C) 2010 by Holger Hans Peter Freyther
3 * (C) 2010 by On-Waves
4 * All Rights Reserved
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License along
17 * with this program; if not, write to the Free Software Foundation, Inc.,
18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
19 *
20 */
21
Holger Hans Peter Freytherbf128002011-11-13 22:48:37 +010022#include <osmocom/core/application.h>
23#include <osmocom/core/logging.h>
Pablo Neira Ayuso83419342011-03-22 16:36:13 +010024#include <osmocom/gsm/gsm0480.h>
Andreas Eversberg95975552013-08-08 12:38:53 +020025#include <osmocom/gsm/gsm_utils.h>
Holger Hans Peter Freytherdaa653f2010-10-11 07:56:06 +020026#include <stdio.h>
27#include <stdlib.h>
28#include <string.h>
29
30static const uint8_t ussd_request[] = {
31 0x0b, 0x7b, 0x1c, 0x15, 0xa1, 0x13, 0x02, 0x01,
32 0x03, 0x02, 0x01, 0x3b, 0x30, 0x0b, 0x04, 0x01,
33 0x0f, 0x04, 0x06, 0x2a, 0xd5, 0x4c, 0x16, 0x1b,
34 0x01, 0x7f, 0x01, 0x00
35};
36
Holger Hans Peter Freyther4a62dbb2016-07-12 17:45:34 +020037static const uint8_t interrogate_ss[] = {
38 0x0b, 0x7b, 0x1c, 0x0d, 0xa1, 0x0b, 0x02, 0x01,
39 0x03, 0x02, 0x01, 0x0e, 0x30, 0x03, 0x04, 0x01,
40 0x21, 0x7f, 0x01, 0x00
41};
42
Holger Hans Peter Freytherdaa653f2010-10-11 07:56:06 +020043static int parse_ussd(const uint8_t *_data, int len)
44{
45 uint8_t *data;
46 int rc;
Tobias Engel419684e2012-03-08 13:31:52 +010047 struct ss_request req;
Holger Hans Peter Freytherdaa653f2010-10-11 07:56:06 +020048 struct gsm48_hdr *hdr;
49
50 data = malloc(len);
51 memcpy(data, _data, len);
52 hdr = (struct gsm48_hdr *) &data[0];
Tobias Engel419684e2012-03-08 13:31:52 +010053 rc = gsm0480_decode_ss_request(hdr, len, &req);
Holger Hans Peter Freytherdaa653f2010-10-11 07:56:06 +020054 free(data);
55
56 return rc;
57}
58
Holger Hans Peter Freytherc88a44f2010-10-11 08:21:00 +020059static int parse_mangle_ussd(const uint8_t *_data, int len)
60{
61 uint8_t *data;
62 int rc;
Tobias Engel419684e2012-03-08 13:31:52 +010063 struct ss_request req;
Holger Hans Peter Freytherc88a44f2010-10-11 08:21:00 +020064 struct gsm48_hdr *hdr;
65
66 data = malloc(len);
67 memcpy(data, _data, len);
68 hdr = (struct gsm48_hdr *) &data[0];
69 hdr->data[1] = len - sizeof(*hdr) - 2;
Tobias Engel419684e2012-03-08 13:31:52 +010070 rc = gsm0480_decode_ss_request(hdr, len, &req);
Holger Hans Peter Freytherc88a44f2010-10-11 08:21:00 +020071 free(data);
72
73 return rc;
74}
75
Holger Hans Peter Freytherbf128002011-11-13 22:48:37 +010076struct log_info info = {};
77
Jacob Erlbeck8a1666b2013-08-08 12:38:54 +020078static void test_7bit_ussd(const char *text, const char *encoded_hex, const char *appended_after_decode)
Andreas Eversberg95975552013-08-08 12:38:53 +020079{
80 uint8_t coded[256];
81 char decoded[256];
Jacob Erlbeck1d7f3b52013-08-12 17:07:53 +020082 int octets_written;
83 int buffer_size;
84 int nchars;
Andreas Eversberg95975552013-08-08 12:38:53 +020085
86 printf("original = %s\n", osmo_hexdump((uint8_t *)text, strlen(text)));
Jacob Erlbeck1d7f3b52013-08-12 17:07:53 +020087 gsm_7bit_encode_n_ussd(coded, sizeof(coded), text, &octets_written);
88 printf("encoded = %s\n", osmo_hexdump(coded, octets_written));
Jacob Erlbeck8a1666b2013-08-08 12:38:54 +020089
Jacob Erlbeck1d7f3b52013-08-12 17:07:53 +020090 OSMO_ASSERT(strcmp(encoded_hex, osmo_hexdump_nospc(coded, octets_written)) == 0);
Jacob Erlbeck8a1666b2013-08-08 12:38:54 +020091
Jacob Erlbeck1d7f3b52013-08-12 17:07:53 +020092 gsm_7bit_decode_n_ussd(decoded, sizeof(decoded), coded, octets_written * 8 / 7);
Vadim Yanitskiybd33a952018-01-20 04:52:43 +060093 printf("decoded = %s\n\n", osmo_hexdump((uint8_t *)decoded, strlen(decoded)));
Jacob Erlbeck8a1666b2013-08-08 12:38:54 +020094
95 OSMO_ASSERT(strncmp(text, decoded, strlen(text)) == 0);
96 OSMO_ASSERT(strcmp(appended_after_decode, decoded + strlen(text)) == 0);
Jacob Erlbeck1d7f3b52013-08-12 17:07:53 +020097
98 /* check buffer limiting */
99 memset(decoded, 0xaa, sizeof(decoded));
100
101 for (buffer_size = 1; buffer_size < sizeof(decoded) - 1; ++buffer_size)
102 {
103 nchars = gsm_7bit_decode_n_ussd(decoded, buffer_size, coded, octets_written * 8 / 7);
104 OSMO_ASSERT(nchars <= buffer_size);
105 OSMO_ASSERT(decoded[buffer_size] == (char)0xaa);
106 OSMO_ASSERT(decoded[nchars] == '\0');
107 }
108
109 memset(coded, 0xaa, sizeof(coded));
110
111 for (buffer_size = 0; buffer_size < sizeof(coded) - 1; ++buffer_size)
112 {
113 gsm_7bit_encode_n_ussd(coded, buffer_size, text, &octets_written);
114 OSMO_ASSERT(octets_written <= buffer_size);
115 OSMO_ASSERT(coded[buffer_size] == 0xaa);
116 }
Andreas Eversberg95975552013-08-08 12:38:53 +0200117}
118
Holger Hans Peter Freytherdaa653f2010-10-11 07:56:06 +0200119int main(int argc, char **argv)
120{
Tobias Engel419684e2012-03-08 13:31:52 +0100121 struct ss_request req;
Vadim Yanitskiyac3b6ac2018-01-17 15:03:32 +0600122 uint16_t size;
Holger Hans Peter Freytherdaa653f2010-10-11 07:56:06 +0200123 int i;
Jacob Erlbeck1d7f3b52013-08-12 17:07:53 +0200124 struct msgb *msg;
Holger Hans Peter Freytherdaa653f2010-10-11 07:56:06 +0200125
Holger Hans Peter Freytherbf128002011-11-13 22:48:37 +0100126 osmo_init_logging(&info);
127
Holger Hans Peter Freyther4a62dbb2016-07-12 17:45:34 +0200128 memset(&req, 0, sizeof(req));
Vadim Yanitskiyac3b6ac2018-01-17 15:03:32 +0600129 gsm0480_decode_ss_request((struct gsm48_hdr *) ussd_request,
130 sizeof(ussd_request), &req);
Tobias Engel419684e2012-03-08 13:31:52 +0100131 printf("Tested if it still works. Text was: %s\n", req.ussd_text);
Holger Hans Peter Freytherf6323712010-10-11 08:49:27 +0200132
Holger Hans Peter Freyther4a62dbb2016-07-12 17:45:34 +0200133 memset(&req, 0, sizeof(req));
Vadim Yanitskiyac3b6ac2018-01-17 15:03:32 +0600134 gsm0480_decode_ss_request((struct gsm48_hdr *) interrogate_ss,
135 sizeof(interrogate_ss), &req);
Holger Hans Peter Freyther4a62dbb2016-07-12 17:45:34 +0200136 OSMO_ASSERT(strlen((char *) req.ussd_text) == 0);
137 OSMO_ASSERT(req.ss_code == 33);
138 printf("interrogateSS CFU text..'%s' code %d\n", req.ussd_text, req.ss_code);
Holger Hans Peter Freytherf6323712010-10-11 08:49:27 +0200139
Holger Hans Peter Freytherdaa653f2010-10-11 07:56:06 +0200140 printf("Testing parsing a USSD request and truncated versions\n");
141
Vadim Yanitskiyac3b6ac2018-01-17 15:03:32 +0600142 size = sizeof(ussd_request);
143
Holger Hans Peter Freytherdaa653f2010-10-11 07:56:06 +0200144 for (i = size; i > sizeof(struct gsm48_hdr); --i) {
145 int rc = parse_ussd(&ussd_request[0], i);
Vadim Yanitskiyc0771d62018-01-10 23:42:19 +0600146 printf("Result for len=%d is %d\n", i, rc);
Holger Hans Peter Freytherdaa653f2010-10-11 07:56:06 +0200147 }
148
Holger Hans Peter Freytherc88a44f2010-10-11 08:21:00 +0200149 printf("Mangling the container now\n");
150 for (i = size; i > sizeof(struct gsm48_hdr) + 2; --i) {
151 int rc = parse_mangle_ussd(&ussd_request[0], i);
Vadim Yanitskiyc0771d62018-01-10 23:42:19 +0600152 printf("Result for len=%d is %d\n", i, rc);
Holger Hans Peter Freytherc88a44f2010-10-11 08:21:00 +0200153 }
154
Andreas Eversberg95975552013-08-08 12:38:53 +0200155 printf("<CR> case test for 7 bit encode\n");
Jacob Erlbeck8a1666b2013-08-08 12:38:54 +0200156 test_7bit_ussd("01234567", "b0986c46abd96e", "");
157 test_7bit_ussd("0123456", "b0986c46abd91a", "");
158 test_7bit_ussd("01234567\r", "b0986c46abd96e0d", "");
159 /* The appended \r is compliant to GSM 03.38 section 6.1.2.3.1: */
160 test_7bit_ussd("0123456\r", "b0986c46abd91a0d", "\r");
161 test_7bit_ussd("012345\r", "b0986c46ab351a", "");
Andreas Eversberg95975552013-08-08 12:38:53 +0200162
Jacob Erlbeck1d7f3b52013-08-12 17:07:53 +0200163 printf("Checking GSM 04.80 USSD message generation.\n");
164
165 test_7bit_ussd("", "", "");
166 msg = gsm0480_create_unstructuredSS_Notify (0x00, "");
167 printf ("Created unstructuredSS_Notify (0x00): %s\n",
168 osmo_hexdump(msgb_data(msg), msgb_length(msg)));
169 msgb_free (msg);
170
171 test_7bit_ussd("forty-two", "e6b79c9e6fd1ef6f", "");
172 msg = gsm0480_create_unstructuredSS_Notify (0x42, "forty-two");
173 printf ("Created unstructuredSS_Notify (0x42): %s\n",
174 osmo_hexdump(msgb_data(msg), msgb_length(msg)));
175 msgb_free (msg);
Holger Hans Peter Freytherdaa653f2010-10-11 07:56:06 +0200176 return 0;
177}