4645af4d9a1a707a919d07027c6f46b884bc6f63
[osmocom-bb.git] / src / gsm / gsm48.c
1 /* GSM Mobile Radio Interface Layer 3 messages
2  * 3GPP TS 04.08 version 7.21.0 Release 1998 / ETSI TS 100 940 V7.21.0 */
3
4 /* (C) 2008-2010 by Harald Welte <laforge@gnumonks.org>
5  * (C) 2008, 2009 by Holger Hans Peter Freyther <zecke@selfish.org>
6  *
7  * All Rights Reserved
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License as published by
11  * the Free Software Foundation; either version 2 of the License, or
12  * (at your option) any later version.
13  *
14  * This program is distributed in the hope that it will be useful,
15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17  * GNU General Public License for more details.
18  *
19  * You should have received a copy of the GNU General Public License along
20  * with this program; if not, write to the Free Software Foundation, Inc.,
21  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
22  *
23  */
24
25 #include <stdint.h>
26 #include <stdio.h>
27 #include <string.h>
28
29 #include <arpa/inet.h>
30
31 #include <osmocom/core/utils.h>
32 #include <osmocom/gsm/tlv.h>
33 #include <osmocom/gsm/gsm48.h>
34
35 #include <osmocom/gsm/protocol/gsm_04_08.h>
36 #include <osmocom/gsm/protocol/gsm_08_58.h>
37
38 const struct tlv_definition gsm48_att_tlvdef = {
39         .def = {
40                 [GSM48_IE_MOBILE_ID]    = { TLV_TYPE_TLV },
41                 [GSM48_IE_NAME_LONG]    = { TLV_TYPE_TLV },
42                 [GSM48_IE_NAME_SHORT]   = { TLV_TYPE_TLV },
43                 [GSM48_IE_UTC]          = { TLV_TYPE_TV },
44                 [GSM48_IE_NET_TIME_TZ]  = { TLV_TYPE_FIXED, 7 },
45                 [GSM48_IE_LSA_IDENT]    = { TLV_TYPE_TLV },
46
47                 [GSM48_IE_BEARER_CAP]   = { TLV_TYPE_TLV },
48                 [GSM48_IE_CAUSE]        = { TLV_TYPE_TLV },
49                 [GSM48_IE_CC_CAP]       = { TLV_TYPE_TLV },
50                 [GSM48_IE_ALERT]        = { TLV_TYPE_TLV },
51                 [GSM48_IE_FACILITY]     = { TLV_TYPE_TLV },
52                 [GSM48_IE_PROGR_IND]    = { TLV_TYPE_TLV },
53                 [GSM48_IE_AUX_STATUS]   = { TLV_TYPE_TLV },
54                 [GSM48_IE_NOTIFY]       = { TLV_TYPE_TV },
55                 [GSM48_IE_KPD_FACILITY] = { TLV_TYPE_TV },
56                 [GSM48_IE_SIGNAL]       = { TLV_TYPE_TV },
57                 [GSM48_IE_CONN_BCD]     = { TLV_TYPE_TLV },
58                 [GSM48_IE_CONN_SUB]     = { TLV_TYPE_TLV },
59                 [GSM48_IE_CALLING_BCD]  = { TLV_TYPE_TLV },
60                 [GSM48_IE_CALLING_SUB]  = { TLV_TYPE_TLV },
61                 [GSM48_IE_CALLED_BCD]   = { TLV_TYPE_TLV },
62                 [GSM48_IE_CALLED_SUB]   = { TLV_TYPE_TLV },
63                 [GSM48_IE_REDIR_BCD]    = { TLV_TYPE_TLV },
64                 [GSM48_IE_REDIR_SUB]    = { TLV_TYPE_TLV },
65                 [GSM48_IE_LOWL_COMPAT]  = { TLV_TYPE_TLV },
66                 [GSM48_IE_HIGHL_COMPAT] = { TLV_TYPE_TLV },
67                 [GSM48_IE_USER_USER]    = { TLV_TYPE_TLV },
68                 [GSM48_IE_SS_VERS]      = { TLV_TYPE_TLV },
69                 [GSM48_IE_MORE_DATA]    = { TLV_TYPE_T },
70                 [GSM48_IE_CLIR_SUPP]    = { TLV_TYPE_T },
71                 [GSM48_IE_CLIR_INVOC]   = { TLV_TYPE_T },
72                 [GSM48_IE_REV_C_SETUP]  = { TLV_TYPE_T },
73                 [GSM48_IE_REPEAT_CIR]   = { TLV_TYPE_T },
74                 [GSM48_IE_REPEAT_SEQ]   = { TLV_TYPE_T },
75                 /* FIXME: more elements */
76         },
77 };
78
79 /* RR elements */
80 const struct tlv_definition gsm48_rr_att_tlvdef = {
81         .def = {
82                 /* NOTE: Don't add IE 17 = MOBILE_ID here, it already used. */
83                 [GSM48_IE_VGCS_TARGET]          = { TLV_TYPE_TLV },
84                 [GSM48_IE_FRQSHORT_AFTER]       = { TLV_TYPE_FIXED, 9 },
85                 [GSM48_IE_MUL_RATE_CFG]         = { TLV_TYPE_TLV },
86                 [GSM48_IE_FREQ_L_AFTER]         = { TLV_TYPE_TLV },
87                 [GSM48_IE_MSLOT_DESC]           = { TLV_TYPE_TLV },
88                 [GSM48_IE_CHANMODE_2]           = { TLV_TYPE_TV },
89                 [GSM48_IE_FRQSHORT_BEFORE]      = { TLV_TYPE_FIXED, 9 },
90                 [GSM48_IE_CHANMODE_3]           = { TLV_TYPE_TV },
91                 [GSM48_IE_CHANMODE_4]           = { TLV_TYPE_TV },
92                 [GSM48_IE_CHANMODE_5]           = { TLV_TYPE_TV },
93                 [GSM48_IE_CHANMODE_6]           = { TLV_TYPE_TV },
94                 [GSM48_IE_CHANMODE_7]           = { TLV_TYPE_TV },
95                 [GSM48_IE_CHANMODE_8]           = { TLV_TYPE_TV },
96                 [GSM48_IE_FREQ_L_BEFORE]        = { TLV_TYPE_TLV },
97                 [GSM48_IE_CH_DESC_1_BEFORE]     = { TLV_TYPE_FIXED, 3 },
98                 [GSM48_IE_CH_DESC_2_BEFORE]     = { TLV_TYPE_FIXED, 3 },
99                 [GSM48_IE_F_CH_SEQ_BEFORE]      = { TLV_TYPE_FIXED, 9 },
100                 [GSM48_IE_CLASSMARK3]           = { TLV_TYPE_TLV },
101                 [GSM48_IE_MA_BEFORE]            = { TLV_TYPE_TLV },
102                 [GSM48_IE_RR_PACKET_UL]         = { TLV_TYPE_TLV },
103                 [GSM48_IE_RR_PACKET_DL]         = { TLV_TYPE_TLV },
104                 [GSM48_IE_CELL_CH_DESC]         = { TLV_TYPE_FIXED, 16 },
105                 [GSM48_IE_CHANMODE_1]           = { TLV_TYPE_TV },
106                 [GSM48_IE_CHDES_2_AFTER]        = { TLV_TYPE_FIXED, 3 },
107                 [GSM48_IE_MODE_SEC_CH]          = { TLV_TYPE_TV },
108                 [GSM48_IE_F_CH_SEQ_AFTER]               = { TLV_TYPE_FIXED, 9 },
109                 [GSM48_IE_MA_AFTER]             = { TLV_TYPE_TLV },
110                 [GSM48_IE_BA_RANGE]             = { TLV_TYPE_TLV },
111                 [GSM48_IE_GROUP_CHDES]          = { TLV_TYPE_TLV },
112                 [GSM48_IE_BA_LIST_PREF]         = { TLV_TYPE_TLV },
113                 [GSM48_IE_MOB_OVSERV_DIF]       = { TLV_TYPE_TLV },
114                 [GSM48_IE_REALTIME_DIFF]        = { TLV_TYPE_TLV },
115                 [GSM48_IE_START_TIME]           = { TLV_TYPE_FIXED, 2 },
116                 [GSM48_IE_TIMING_ADVANCE]       = { TLV_TYPE_TV },
117                 [GSM48_IE_GROUP_CIP_SEQ]        = { TLV_TYPE_SINGLE_TV },
118                 [GSM48_IE_CIP_MODE_SET]         = { TLV_TYPE_SINGLE_TV },
119                 [GSM48_IE_GPRS_RESUMPT]         = { TLV_TYPE_SINGLE_TV },
120                 [GSM48_IE_SYNC_IND]             = { TLV_TYPE_SINGLE_TV },
121         },
122 };
123
124 /* MM elements */
125 const struct tlv_definition gsm48_mm_att_tlvdef = {
126         .def = {
127                 [GSM48_IE_MOBILE_ID]            = { TLV_TYPE_TLV },
128                 [GSM48_IE_NAME_LONG]            = { TLV_TYPE_TLV },
129                 [GSM48_IE_NAME_SHORT]           = { TLV_TYPE_TLV },
130                 [GSM48_IE_UTC]                  = { TLV_TYPE_TV },
131                 [GSM48_IE_NET_TIME_TZ]          = { TLV_TYPE_FIXED, 7 },
132                 [GSM48_IE_LSA_IDENT]            = { TLV_TYPE_TLV },
133
134                 [GSM48_IE_LOCATION_AREA]        = { TLV_TYPE_FIXED, 5 },
135                 [GSM48_IE_PRIORITY_LEV]         = { TLV_TYPE_SINGLE_TV },
136                 [GSM48_IE_FOLLOW_ON_PROC]       = { TLV_TYPE_T },
137                 [GSM48_IE_CTS_PERMISSION]       = { TLV_TYPE_T },
138         },
139 };
140
141 static const struct value_string rr_cause_names[] = {
142         { GSM48_RR_CAUSE_NORMAL,                "Normal event" },
143         { GSM48_RR_CAUSE_ABNORMAL_UNSPEC,       "Abnormal release, unspecified" },
144         { GSM48_RR_CAUSE_ABNORMAL_UNACCT,       "Abnormal release, channel unacceptable" },
145         { GSM48_RR_CAUSE_ABNORMAL_TIMER,        "Abnormal release, timer expired" },
146         { GSM48_RR_CAUSE_ABNORMAL_NOACT,        "Abnormal release, no activity on radio path" },
147         { GSM48_RR_CAUSE_PREMPTIVE_REL,         "Preemptive release" },
148         { GSM48_RR_CAUSE_HNDOVER_IMP,           "Handover impossible, timing advance out of range" },
149         { GSM48_RR_CAUSE_CHAN_MODE_UNACCT,      "Channel mode unacceptable" },
150         { GSM48_RR_CAUSE_FREQ_NOT_IMPL,         "Frequency not implemented" },
151         { GSM48_RR_CAUSE_CALL_CLEARED,          "Call already cleared" },
152         { GSM48_RR_CAUSE_SEMANT_INCORR,         "Semantically incorrect message" },
153         { GSM48_RR_CAUSE_INVALID_MAND_INF,      "Invalid mandatory information" },
154         { GSM48_RR_CAUSE_MSG_TYPE_N,            "Message type non-existant or not implemented" },
155         { GSM48_RR_CAUSE_MSG_TYPE_N_COMPAT,     "Message type not compatible with protocol state" },
156         { GSM48_RR_CAUSE_COND_IE_ERROR,         "Conditional IE error" },
157         { GSM48_RR_CAUSE_NO_CELL_ALLOC_A,       "No cell allocation available" },
158         { GSM48_RR_CAUSE_PROT_ERROR_UNSPC,      "Protocol error unspecified" },
159         { 0,                                    NULL },
160 };
161
162 /* FIXME: convert to value_string */
163 static const char *cc_state_names[32] = {
164         "NULL",
165         "INITIATED",
166         "MM_CONNECTION_PEND",
167         "MO_CALL_PROC",
168         "CALL_DELIVERED",
169         "illegal state 5",
170         "CALL_PRESENT",
171         "CALL_RECEIVED",
172         "CONNECT_REQUEST",
173         "MO_TERM_CALL_CONF",
174         "ACTIVE",
175         "DISCONNECT_REQ",
176         "DISCONNECT_IND",
177         "illegal state 13",
178         "illegal state 14",
179         "illegal state 15",
180         "illegal state 16",
181         "illegal state 17",
182         "illegal state 18",
183         "RELEASE_REQ",
184         "illegal state 20",
185         "illegal state 21",
186         "illegal state 22",
187         "illegal state 23",
188         "illegal state 24",
189         "illegal state 25",
190         "MO_ORIG_MODIFY",
191         "MO_TERM_MODIFY",
192         "CONNECT_IND",
193         "illegal state 29",
194         "illegal state 30",
195         "illegal state 31",
196 };
197
198 const char *gsm48_cc_state_name(uint8_t state)
199 {
200         if (state < ARRAY_SIZE(cc_state_names))
201                 return cc_state_names[state];
202
203         return "invalid";
204 }
205
206 static const struct value_string cc_msg_names[] = {
207         { GSM48_MT_CC_ALERTING,         "ALERTING" },
208         { GSM48_MT_CC_CALL_PROC,        "CALL_PROC" },
209         { GSM48_MT_CC_PROGRESS,         "PROGRESS" },
210         { GSM48_MT_CC_ESTAB,            "ESTAB" },
211         { GSM48_MT_CC_SETUP,            "SETUP" },
212         { GSM48_MT_CC_ESTAB_CONF,       "ESTAB_CONF" },
213         { GSM48_MT_CC_CONNECT,          "CONNECT" },
214         { GSM48_MT_CC_CALL_CONF,        "CALL_CONF" },
215         { GSM48_MT_CC_START_CC,         "START_CC" },
216         { GSM48_MT_CC_RECALL,           "RECALL" },
217         { GSM48_MT_CC_EMERG_SETUP,      "EMERG_SETUP" },
218         { GSM48_MT_CC_CONNECT_ACK,      "CONNECT_ACK" },
219         { GSM48_MT_CC_USER_INFO,        "USER_INFO" },
220         { GSM48_MT_CC_MODIFY_REJECT,    "MODIFY_REJECT" },
221         { GSM48_MT_CC_MODIFY,           "MODIFY" },
222         { GSM48_MT_CC_HOLD,             "HOLD" },
223         { GSM48_MT_CC_HOLD_ACK,         "HOLD_ACK" },
224         { GSM48_MT_CC_HOLD_REJ,         "HOLD_REJ" },
225         { GSM48_MT_CC_RETR,             "RETR" },
226         { GSM48_MT_CC_RETR_ACK,         "RETR_ACK" },
227         { GSM48_MT_CC_RETR_REJ,         "RETR_REJ" },
228         { GSM48_MT_CC_MODIFY_COMPL,     "MODIFY_COMPL" },
229         { GSM48_MT_CC_DISCONNECT,       "DISCONNECT" },
230         { GSM48_MT_CC_RELEASE_COMPL,    "RELEASE_COMPL" },
231         { GSM48_MT_CC_RELEASE,          "RELEASE" },
232         { GSM48_MT_CC_STOP_DTMF,        "STOP_DTMF" },
233         { GSM48_MT_CC_STOP_DTMF_ACK,    "STOP_DTMF_ACK" },
234         { GSM48_MT_CC_STATUS_ENQ,       "STATUS_ENQ" },
235         { GSM48_MT_CC_START_DTMF,       "START_DTMF" },
236         { GSM48_MT_CC_START_DTMF_ACK,   "START_DTMF_ACK" },
237         { GSM48_MT_CC_START_DTMF_REJ,   "START_DTMF_REJ" },
238         { GSM48_MT_CC_CONG_CTRL,        "CONG_CTRL" },
239         { GSM48_MT_CC_FACILITY,         "FACILITY" },
240         { GSM48_MT_CC_STATUS,           "STATUS" },
241         { GSM48_MT_CC_NOTIFY,           "NOTFIY" },
242         { 0,                            NULL }
243 };
244
245 const char *gsm48_cc_msg_name(uint8_t msgtype)
246 {
247         return get_value_string(cc_msg_names, msgtype);
248 }
249
250 const char *rr_cause_name(uint8_t cause)
251 {
252         return get_value_string(rr_cause_names, cause);
253 }
254
255 static void to_bcd(uint8_t *bcd, uint16_t val)
256 {
257         bcd[2] = val % 10;
258         val = val / 10;
259         bcd[1] = val % 10;
260         val = val / 10;
261         bcd[0] = val % 10;
262         val = val / 10;
263 }
264
265 void gsm48_generate_lai(struct gsm48_loc_area_id *lai48, uint16_t mcc,
266                         uint16_t mnc, uint16_t lac)
267 {
268         uint8_t bcd[3];
269
270         to_bcd(bcd, mcc);
271         lai48->digits[0] = bcd[0] | (bcd[1] << 4);
272         lai48->digits[1] = bcd[2];
273
274         to_bcd(bcd, mnc);
275         /* FIXME: do we need three-digit MNC? See Table 10.5.3 */
276         if (mnc > 99) {
277                 lai48->digits[1] |= bcd[2] << 4;
278                 lai48->digits[2] = bcd[0] | (bcd[1] << 4);
279         } else {
280                 lai48->digits[1] |= 0xf << 4;
281                 lai48->digits[2] = bcd[1] | (bcd[2] << 4);
282         }
283
284         lai48->lac = htons(lac);
285 }
286
287 int gsm48_generate_mid_from_tmsi(uint8_t *buf, uint32_t tmsi)
288 {
289         uint32_t *tptr = (uint32_t *) &buf[3];
290
291         buf[0] = GSM48_IE_MOBILE_ID;
292         buf[1] = GSM48_TMSI_LEN;
293         buf[2] = 0xf0 | GSM_MI_TYPE_TMSI;
294         *tptr = htonl(tmsi);
295
296         return 7;
297 }
298
299 int gsm48_generate_mid_from_imsi(uint8_t *buf, const char *imsi)
300 {
301         unsigned int length = strlen(imsi), i, off = 0;
302         uint8_t odd = (length & 0x1) == 1;
303
304         buf[0] = GSM48_IE_MOBILE_ID;
305         buf[2] = osmo_char2bcd(imsi[0]) << 4 | GSM_MI_TYPE_IMSI | (odd << 3);
306
307         /* if the length is even we will fill half of the last octet */
308         if (odd)
309                 buf[1] = (length + 1) >> 1;
310         else
311                 buf[1] = (length + 2) >> 1;
312
313         for (i = 1; i < buf[1]; ++i) {
314                 uint8_t lower, upper;
315
316                 lower = osmo_char2bcd(imsi[++off]);
317                 if (!odd && off + 1 == length)
318                         upper = 0x0f;
319                 else
320                         upper = osmo_char2bcd(imsi[++off]) & 0x0f;
321
322                 buf[2 + i] = (upper << 4) | lower;
323         }
324
325         return 2 + buf[1];
326 }
327
328 /* Convert Mobile Identity (10.5.1.4) to string */
329 int gsm48_mi_to_string(char *string, const int str_len, const uint8_t *mi,
330                        const int mi_len)
331 {
332         int i;
333         uint8_t mi_type;
334         char *str_cur = string;
335         uint32_t tmsi;
336
337         mi_type = mi[0] & GSM_MI_TYPE_MASK;
338
339         switch (mi_type) {
340         case GSM_MI_TYPE_NONE:
341                 break;
342         case GSM_MI_TYPE_TMSI:
343                 /* Table 10.5.4.3, reverse generate_mid_from_tmsi */
344                 if (mi_len == GSM48_TMSI_LEN && mi[0] == (0xf0 | GSM_MI_TYPE_TMSI)) {
345                         memcpy(&tmsi, &mi[1], 4);
346                         tmsi = ntohl(tmsi);
347                         return snprintf(string, str_len, "%u", tmsi);
348                 }
349                 break;
350         case GSM_MI_TYPE_IMSI:
351         case GSM_MI_TYPE_IMEI:
352         case GSM_MI_TYPE_IMEISV:
353                 *str_cur++ = osmo_bcd2char(mi[0] >> 4);
354
355                 for (i = 1; i < mi_len; i++) {
356                         if (str_cur + 2 >= string + str_len)
357                                 return str_cur - string;
358                         *str_cur++ = osmo_bcd2char(mi[i] & 0xf);
359                         /* skip last nibble in last input byte when GSM_EVEN */
360                         if( (i != mi_len-1) || (mi[0] & GSM_MI_ODD))
361                                 *str_cur++ = osmo_bcd2char(mi[i] >> 4);
362                 }
363                 break;
364         default:
365                 break;
366         }
367         *str_cur++ = '\0';
368
369         return str_cur - string;
370 }
371
372 void gsm48_parse_ra(struct gprs_ra_id *raid, const uint8_t *buf)
373 {
374         raid->mcc = (buf[0] & 0xf) * 100;
375         raid->mcc += (buf[0] >> 4) * 10;
376         raid->mcc += (buf[1] & 0xf) * 1;
377
378         /* I wonder who came up with the stupidity of encoding the MNC
379          * differently depending on how many digits its decimal number has! */
380         if ((buf[1] >> 4) == 0xf) {
381                 raid->mnc = (buf[2] & 0xf) * 10;
382                 raid->mnc += (buf[2] >> 4) * 1;
383         } else {
384                 raid->mnc = (buf[2] & 0xf) * 100;
385                 raid->mnc += (buf[2] >> 4) * 10;
386                 raid->mnc += (buf[1] >> 4) * 1;
387         }
388
389         raid->lac = ntohs(*(uint16_t *)(buf + 3));
390         raid->rac = buf[5];
391 }
392
393 int gsm48_construct_ra(uint8_t *buf, const struct gprs_ra_id *raid)
394 {
395         uint16_t mcc = raid->mcc;
396         uint16_t mnc = raid->mnc;
397
398         buf[0] = ((mcc / 100) % 10) | (((mcc / 10) % 10) << 4);
399         buf[1] = (mcc % 10);
400
401         /* I wonder who came up with the stupidity of encoding the MNC
402          * differently depending on how many digits its decimal number has! */
403         if (mnc < 100) {
404                 buf[1] |= 0xf0;
405                 buf[2] = ((mnc / 10) % 10) | ((mnc % 10) << 4);
406         } else {
407                 buf[1] |= (mnc % 10) << 4;
408                 buf[2] = ((mnc / 100) % 10) | (((mcc / 10) % 10) << 4);
409         }
410
411         *(uint16_t *)(buf+3) = htons(raid->lac);
412
413         buf[5] = raid->rac;
414
415         return 6;
416 }
417
418 /* From Table 10.5.33 of GSM 04.08 */
419 int gsm48_number_of_paging_subchannels(struct gsm48_control_channel_descr *chan_desc)
420 {
421         if (chan_desc->ccch_conf == RSL_BCCH_CCCH_CONF_1_C) {
422                 return OSMO_MAX(1, (3 - chan_desc->bs_ag_blks_res))
423                         * (chan_desc->bs_pa_mfrms + 2);
424         } else {
425                 return (9 - chan_desc->bs_ag_blks_res)
426                         * (chan_desc->bs_pa_mfrms + 2);
427         }
428 }