[layer23] Speech codec selection and negotiation with network
[osmocom-bb.git] / src / host / layer23 / src / mobile / vty_interface.c
1 /*
2  * (C) 2010 by Andreas Eversberg <jolly@eversberg.eu>
3  *
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
22 #include <string.h>
23 #include <stdlib.h>
24 #include <stdarg.h>
25 #include <unistd.h>
26 #include <sys/types.h>
27
28 #include <osmocore/utils.h>
29 #include <osmocore/gsm48.h>
30
31 #include <osmocom/bb/common/osmocom_data.h>
32 #include <osmocom/bb/common/networks.h>
33 #include <osmocom/bb/mobile/mncc.h>
34 #include <osmocom/bb/mobile/transaction.h>
35 #include <osmocom/bb/mobile/vty.h>
36 #include <osmocom/bb/mobile/gps.h>
37 #include <osmocom/vty/telnet_interface.h>
38
39 int mncc_call(struct osmocom_ms *ms, char *number);
40 int mncc_hangup(struct osmocom_ms *ms);
41 int mncc_answer(struct osmocom_ms *ms);
42 int mncc_hold(struct osmocom_ms *ms);
43 int mncc_retrieve(struct osmocom_ms *ms, int number);
44
45 extern struct llist_head ms_list;
46 extern struct llist_head active_connections;
47
48 struct cmd_node ms_node = {
49         MS_NODE,
50         "%s(ms)#",
51         1
52 };
53
54 struct cmd_node testsim_node = {
55         TESTSIM_NODE,
56         "%s(test-sim)#",
57         1
58 };
59
60 static void print_vty(void *priv, const char *fmt, ...)
61 {
62         char buffer[1000];
63         struct vty *vty = priv;
64         va_list args;
65
66         va_start(args, fmt);
67         vsnprintf(buffer, sizeof(buffer) - 1, fmt, args);
68         buffer[sizeof(buffer) - 1] = '\0';
69         va_end(args);
70
71         if (buffer[0]) {
72                 if (buffer[strlen(buffer) - 1] == '\n') {
73                         buffer[strlen(buffer) - 1] = '\0';
74                         vty_out(vty, "%s%s", buffer, VTY_NEWLINE);
75                 } else
76                         vty_out(vty, "%s", buffer);
77         }
78 }
79
80 static struct osmocom_ms *get_ms(const char *name, struct vty *vty)
81 {
82         struct osmocom_ms *ms;
83
84         llist_for_each_entry(ms, &ms_list, entity) {
85                 if (!strcmp(ms->name, name))
86                         return ms;
87         }
88         vty_out(vty, "MS name '%s' does not exits.%s", name, VTY_NEWLINE);
89
90         return NULL;
91 }
92
93 DEFUN(show_ms, show_ms_cmd, "show ms",
94         SHOW_STR "Display available MS entities\n")
95 {
96         struct osmocom_ms *ms;
97
98         llist_for_each_entry(ms, &ms_list, entity) {
99                 struct gsm_settings *set = &ms->settings;
100
101                 vty_out(vty, "MS NAME: %s%s", ms->name, VTY_NEWLINE);
102                 vty_out(vty, " IMEI: %s%s", set->imei, VTY_NEWLINE);
103                 vty_out(vty, " IMEISV: %s%s", set->imeisv, VTY_NEWLINE);
104                 if (set->imei_random)
105                         vty_out(vty, " IMEI generation: random (%d trailing "
106                                 "digits)%s", set->imei_random, VTY_NEWLINE);
107                 else
108                         vty_out(vty, " IMEI generation: fixed%s", VTY_NEWLINE);
109                 vty_out(vty, " network selection mode: %s%s",
110                         (set->plmn_mode == PLMN_MODE_AUTO)
111                                 ? "automatic" : "manual", VTY_NEWLINE);
112         }
113
114         return CMD_SUCCESS;
115 }
116
117 DEFUN(show_support, show_support_cmd, "show support [ms_name]",
118         SHOW_STR "Display information about MS support\n"
119         "Name of MS (see \"show ms\")")
120 {
121         struct osmocom_ms *ms;
122
123         if (argc) {
124                 ms = get_ms(argv[0], vty);
125                 if (!ms)
126                         return CMD_WARNING;
127                 gsm_support_dump(&ms->support, print_vty, vty);
128         } else {
129                 llist_for_each_entry(ms, &ms_list, entity) {
130                         gsm_support_dump(&ms->support, print_vty, vty);
131                         vty_out(vty, "%s", VTY_NEWLINE);
132                 }
133         }
134
135         return CMD_SUCCESS;
136 }
137
138 static void gsm_states_dump(struct osmocom_ms *ms, struct vty *vty)
139 {
140         struct gsm_trans *trans;
141
142         vty_out(vty, "Current state of MS '%s'%s", ms->name, VTY_NEWLINE);
143         if (ms->settings.plmn_mode == PLMN_MODE_AUTO)
144                 vty_out(vty, " automatic network selection: %s%s", 
145                         plmn_a_state_names[ms->plmn.state], VTY_NEWLINE);
146         else
147                 vty_out(vty, " manual network selection: %s%s", 
148                         plmn_m_state_names[ms->plmn.state], VTY_NEWLINE);
149         vty_out(vty, " cell selection: %s%s", 
150                 cs_state_names[ms->cellsel.state], VTY_NEWLINE);
151         vty_out(vty, " radio ressource layer: %s%s", 
152                 gsm48_rr_state_names[ms->rrlayer.state], VTY_NEWLINE);
153         vty_out(vty, " mobility management layer: %s", 
154                 gsm48_mm_state_names[ms->mmlayer.state]);
155         if (ms->mmlayer.state == GSM48_MM_ST_MM_IDLE)
156                 vty_out(vty, ", %s", 
157                         gsm48_mm_substate_names[ms->mmlayer.substate]);
158         vty_out(vty, "%s", VTY_NEWLINE);
159         llist_for_each_entry(trans, &ms->trans_list, entry) {
160                 vty_out(vty, " call control: %s%s", 
161                         gsm48_cc_state_name(trans->cc.state), VTY_NEWLINE);
162         }
163 }
164
165 DEFUN(show_states, show_states_cmd, "show states [ms_name]",
166         SHOW_STR "Display current states of given MS\n"
167         "Name of MS (see \"show ms\")")
168 {
169         struct osmocom_ms *ms;
170
171         if (argc) {
172                 ms = get_ms(argv[0], vty);
173                 if (!ms)
174                         return CMD_WARNING;
175                 gsm_states_dump(ms, vty);
176         } else {
177                 llist_for_each_entry(ms, &ms_list, entity) {
178                         gsm_states_dump(ms, vty);
179                         vty_out(vty, "%s", VTY_NEWLINE);
180                 }
181         }
182
183         return CMD_SUCCESS;
184 }
185
186 DEFUN(show_subscr, show_subscr_cmd, "show subscriber [ms_name]",
187         SHOW_STR "Display information about subscriber\n"
188         "Name of MS (see \"show ms\")")
189 {
190         struct osmocom_ms *ms;
191
192         if (argc) {
193                 ms = get_ms(argv[0], vty);
194                 if (!ms)
195                         return CMD_WARNING;
196                 gsm_subscr_dump(&ms->subscr, print_vty, vty);
197         } else {
198                 llist_for_each_entry(ms, &ms_list, entity) {
199                         gsm_subscr_dump(&ms->subscr, print_vty, vty);
200                         vty_out(vty, "%s", VTY_NEWLINE);
201                 }
202         }
203
204         return CMD_SUCCESS;
205 }
206
207 DEFUN(show_cell, show_cell_cmd, "show cell MS_NAME",
208         SHOW_STR "Display information about received cells\n"
209         "Name of MS (see \"show ms\")")
210 {
211         struct osmocom_ms *ms;
212
213         ms = get_ms(argv[0], vty);
214         if (!ms)
215                 return CMD_WARNING;
216
217         gsm322_dump_cs_list(&ms->cellsel, GSM322_CS_FLAG_SYSINFO, print_vty,
218                 vty);
219
220         return CMD_SUCCESS;
221 }
222
223 DEFUN(show_cell_si, show_cell_si_cmd, "show cell MS_NAME <0-1023>",
224         SHOW_STR "Display information about received cell\n"
225         "Name of MS (see \"show ms\")\nRadio frequency number")
226 {
227         struct osmocom_ms *ms;
228         int i;
229         struct gsm48_sysinfo *s;
230
231         ms = get_ms(argv[0], vty);
232         if (!ms)
233                 return CMD_WARNING;
234
235         i = atoi(argv[1]);
236         if (i < 0 || i > 1023) {
237                 vty_out(vty, "Given ARFCN '%s' not in range (0..1023)%s",
238                         argv[1], VTY_NEWLINE);
239                 return CMD_WARNING;
240         }
241         s = ms->cellsel.list[i].sysinfo;
242         if (!s) {
243                 vty_out(vty, "Given ARFCN '%s' has no sysinfo available%s",
244                         argv[1], VTY_NEWLINE);
245                 return CMD_SUCCESS;
246         }
247
248         gsm48_sysinfo_dump(s, i, print_vty, vty);
249
250         return CMD_SUCCESS;
251 }
252
253 DEFUN(show_ba, show_ba_cmd, "show ba MS_NAME [mcc] [mnc]",
254         SHOW_STR "Display information about band allocations\n"
255         "Name of MS (see \"show ms\")\nMobile Country Code\n"
256         "Mobile Network Code")
257 {
258         struct osmocom_ms *ms;
259         uint16_t mcc = 0, mnc = 0;
260
261         ms = get_ms(argv[0], vty);
262         if (!ms)
263                 return CMD_WARNING;
264
265         if (argc >= 3) {
266                 mcc = gsm_input_mcc((char *)argv[1]);
267                 mnc = gsm_input_mnc((char *)argv[2]);
268                 if (!mcc) {
269                         vty_out(vty, "Given MCC invalid%s", VTY_NEWLINE);
270                         return CMD_WARNING;
271                 }
272                 if (!mnc) {
273                         vty_out(vty, "Given MNC invalid%s", VTY_NEWLINE);
274                         return CMD_WARNING;
275                 }
276         }
277
278         gsm322_dump_ba_list(&ms->cellsel, mcc, mnc, print_vty, vty);
279
280         return CMD_SUCCESS;
281 }
282
283 DEFUN(show_forb_plmn, show_forb_plmn_cmd, "show forbidden plmn MS_NAME",
284         SHOW_STR "Display information about forbidden cells / networks\n"
285         "Display forbidden PLMNs\nName of MS (see \"show ms\")")
286 {
287         struct osmocom_ms *ms;
288
289         ms = get_ms(argv[0], vty);
290         if (!ms)
291                 return CMD_WARNING;
292
293         gsm_subscr_dump_forbidden_plmn(ms, print_vty, vty);
294
295         return CMD_SUCCESS;
296 }
297
298 DEFUN(show_forb_la, show_forb_la_cmd, "show forbidden location-area MS_NAME",
299         SHOW_STR "Display information about forbidden cells / networks\n"
300         "Display forbidden location areas\nName of MS (see \"show ms\")")
301 {
302         struct osmocom_ms *ms;
303
304         ms = get_ms(argv[0], vty);
305         if (!ms)
306                 return CMD_WARNING;
307
308         gsm322_dump_forbidden_la(ms, print_vty, vty);
309
310         return CMD_SUCCESS;
311 }
312
313 DEFUN(monitor_network, monitor_network_cmd, "monitor network MS_NAME",
314         "Monitor...\nMonitor network information\nName of MS (see \"show ms\")")
315 {
316         struct osmocom_ms *ms;
317
318         ms = get_ms(argv[0], vty);
319         if (!ms)
320                 return CMD_WARNING;
321
322         gsm48_rr_start_monitor(ms);
323
324         return CMD_SUCCESS;
325 }
326
327 DEFUN(no_monitor_network, no_monitor_network_cmd, "no monitor network MS_NAME",
328         NO_STR "Monitor...\nDeactivate monitor of network information\n"
329         "Name of MS (see \"show ms\")")
330 {
331         struct osmocom_ms *ms;
332
333         ms = get_ms(argv[0], vty);
334         if (!ms)
335                 return CMD_WARNING;
336
337         gsm48_rr_stop_monitor(ms);
338
339         return CMD_SUCCESS;
340 }
341
342 DEFUN(sim_test, sim_test_cmd, "sim testcard MS_NAME [mcc] [mnc]",
343         "SIM actions\nInsert test card\nName of MS (see \"show ms\")\n"
344         "Mobile Country Code of RPLMN\nMobile Network Code of RPLMN")
345 {
346         struct osmocom_ms *ms;
347         uint16_t mcc = 0x001, mnc = 0x01f;
348
349         ms = get_ms(argv[0], vty);
350         if (!ms)
351                 return CMD_WARNING;
352
353         if (ms->subscr.sim_valid) {
354                 vty_out(vty, "SIM already presend, remove first!%s",
355                         VTY_NEWLINE);
356                 return CMD_WARNING;
357         }
358
359         if (argc >= 3) {
360                 mcc = gsm_input_mcc((char *)argv[1]);
361                 mnc = gsm_input_mnc((char *)argv[2]);
362                 if (!mcc) {
363                         vty_out(vty, "Given MCC invalid%s", VTY_NEWLINE);
364                         return CMD_WARNING;
365                 }
366                 if (!mnc) {
367                         vty_out(vty, "Given MNC invalid%s", VTY_NEWLINE);
368                         return CMD_WARNING;
369                 }
370         }
371
372         gsm_subscr_testcard(ms, mcc, mnc);
373
374         return CMD_SUCCESS;
375 }
376
377 DEFUN(sim_reader, sim_reader_cmd, "sim reader MS_NAME",
378         "SIM actions\nSelect SIM from reader\nName of MS (see \"show ms\")")
379 {
380         struct osmocom_ms *ms;
381
382         ms = get_ms(argv[0], vty);
383         if (!ms)
384                 return CMD_WARNING;
385
386         if (ms->subscr.sim_valid) {
387                 vty_out(vty, "SIM already presend, remove first!%s",
388                         VTY_NEWLINE);
389                 return CMD_WARNING;
390         }
391
392         gsm_subscr_simcard(ms);
393
394         return CMD_SUCCESS;
395 }
396
397 DEFUN(sim_remove, sim_remove_cmd, "sim remove MS_NAME",
398         "SIM actions\nRemove SIM card\nName of MS (see \"show ms\")")
399 {
400         struct osmocom_ms *ms;
401
402         ms = get_ms(argv[0], vty);
403         if (!ms)
404                 return CMD_WARNING;
405
406         if (!ms->subscr.sim_valid) {
407                 vty_out(vty, "No Sim inserted!%s", VTY_NEWLINE);
408                 return CMD_WARNING;
409         }
410
411         gsm_subscr_remove(ms);
412
413         return CMD_SUCCESS;
414 }
415
416 DEFUN(sim_pin, sim_pin_cmd, "sim pin MS_NAME PIN",
417         "SIM actions\nEnter PIN for SIM card\nName of MS (see \"show ms\")\n"
418         "PIN number")
419 {
420         struct osmocom_ms *ms;
421
422         ms = get_ms(argv[0], vty);
423         if (!ms)
424                 return CMD_WARNING;
425
426         if (strlen(argv[1]) < 4 || strlen(argv[1]) > 8) {
427                 vty_out(vty, "PIN must be in range 4..8!%s", VTY_NEWLINE);
428                 return CMD_WARNING;
429         }
430
431         if (!ms->subscr.sim_pin_required) {
432                 vty_out(vty, "No PIN is required at this time!%s", VTY_NEWLINE);
433                 return CMD_WARNING;
434         }
435
436         gsm_subscr_sim_pin(ms, (char *)argv[1], "", 0);
437
438         return CMD_SUCCESS;
439 }
440
441 DEFUN(sim_disable_pin, sim_disable_pin_cmd, "sim disable-pin MS_NAME PIN",
442         "SIM actions\nDisable PIN of SIM card\nName of MS (see \"show ms\")\n"
443         "PIN number")
444 {
445         struct osmocom_ms *ms;
446
447         ms = get_ms(argv[0], vty);
448         if (!ms)
449                 return CMD_WARNING;
450
451         if (strlen(argv[1]) < 4 || strlen(argv[1]) > 8) {
452                 vty_out(vty, "PIN must be in range 4..8!%s", VTY_NEWLINE);
453                 return CMD_WARNING;
454         }
455
456         gsm_subscr_sim_pin(ms, (char *)argv[1], "", -1);
457
458         return CMD_SUCCESS;
459 }
460
461 DEFUN(sim_enable_pin, sim_enable_pin_cmd, "sim enable-pin MS_NAME PIN",
462         "SIM actions\nEnable PIN of SIM card\nName of MS (see \"show ms\")\n"
463         "PIN number")
464 {
465         struct osmocom_ms *ms;
466
467         ms = get_ms(argv[0], vty);
468         if (!ms)
469                 return CMD_WARNING;
470
471         if (strlen(argv[1]) < 4 || strlen(argv[1]) > 8) {
472                 vty_out(vty, "PIN must be in range 4..8!%s", VTY_NEWLINE);
473                 return CMD_WARNING;
474         }
475
476         gsm_subscr_sim_pin(ms, (char *)argv[1], "", 1);
477
478         return CMD_SUCCESS;
479 }
480
481 DEFUN(sim_change_pin, sim_change_pin_cmd, "sim change-pin MS_NAME OLD NEW",
482         "SIM actions\nChange PIN of SIM card\nName of MS (see \"show ms\")\n"
483         "Old PIN number\nNew PIN number")
484 {
485         struct osmocom_ms *ms;
486
487         ms = get_ms(argv[0], vty);
488         if (!ms)
489                 return CMD_WARNING;
490
491         if (strlen(argv[1]) < 4 || strlen(argv[1]) > 8) {
492                 vty_out(vty, "Old PIN must be in range 4..8!%s", VTY_NEWLINE);
493                 return CMD_WARNING;
494         }
495         if (strlen(argv[2]) < 4 || strlen(argv[2]) > 8) {
496                 vty_out(vty, "New PIN must be in range 4..8!%s", VTY_NEWLINE);
497                 return CMD_WARNING;
498         }
499
500         gsm_subscr_sim_pin(ms, (char *)argv[1], (char *)argv[2], 2);
501
502         return CMD_SUCCESS;
503 }
504
505 DEFUN(sim_unblock_pin, sim_unblock_pin_cmd, "sim unblock-pin MS_NAME PUC NEW",
506         "SIM actions\nChange PIN of SIM card\nName of MS (see \"show ms\")\n"
507         "Personal Unblock Key\nNew PIN number")
508 {
509         struct osmocom_ms *ms;
510
511         ms = get_ms(argv[0], vty);
512         if (!ms)
513                 return CMD_WARNING;
514
515         if (strlen(argv[1]) != 8) {
516                 vty_out(vty, "PUC must be 8 digits!%s", VTY_NEWLINE);
517                 return CMD_WARNING;
518         }
519         if (strlen(argv[2]) < 4 || strlen(argv[2]) > 8) {
520                 vty_out(vty, "PIN must be in range 4..8!%s", VTY_NEWLINE);
521                 return CMD_WARNING;
522         }
523
524         gsm_subscr_sim_pin(ms, (char *)argv[1], (char *)argv[2], 99);
525
526         return CMD_SUCCESS;
527 }
528
529 DEFUN(network_select, network_select_cmd, "network select MS_NAME MCC MNC",
530         "Select ...\nSelect Network\nName of MS (see \"show ms\")\n"
531         "Mobile Country Code\nMobile Network Code")
532 {
533         struct osmocom_ms *ms;
534         struct gsm322_plmn *plmn;
535         struct msgb *nmsg;
536         struct gsm322_msg *ngm;
537         struct gsm322_plmn_list *temp;
538         uint16_t mcc = gsm_input_mcc((char *)argv[1]),
539                  mnc = gsm_input_mnc((char *)argv[2]);
540         int found = 0;
541
542         ms = get_ms(argv[0], vty);
543         if (!ms)
544                 return CMD_WARNING;
545         plmn = &ms->plmn;
546
547         if (!mcc) {
548                 vty_out(vty, "Given MCC invalid%s", VTY_NEWLINE);
549                 return CMD_WARNING;
550         }
551         if (!mnc) {
552                 vty_out(vty, "Given MNC invalid%s", VTY_NEWLINE);
553                 return CMD_WARNING;
554         }
555
556         llist_for_each_entry(temp, &plmn->sorted_plmn, entry)
557                 if (temp->mcc == mcc &&  temp->mnc == mnc)
558                         found = 1;
559         if (!found) {
560                 vty_out(vty, "Network not in list!%s", VTY_NEWLINE);
561                 return CMD_WARNING;
562         }
563
564         nmsg = gsm322_msgb_alloc(GSM322_EVENT_CHOOSE_PLMN);
565         if (!nmsg)
566                 return CMD_WARNING;
567         ngm = (struct gsm322_msg *) nmsg->data;
568         ngm->mcc = mcc;
569         ngm->mnc = mnc;
570         gsm322_plmn_sendmsg(ms, nmsg);
571
572         return CMD_SUCCESS;
573 }
574
575 DEFUN(call, call_cmd, "call MS_NAME (NUMBER|emergency|answer|hangup|hold)",
576         "Make a call\nName of MS (see \"show ms\")\nPhone number to call "
577         "(Use digits '0123456789*#abc', and '+' to dial international)\n"
578         "Make an emergency call\nAnswer an incomming call\nHangup a call\n"
579         "Hold current active call\n")
580 {
581         struct osmocom_ms *ms;
582         int i;
583
584         ms = get_ms(argv[0], vty);
585         if (!ms)
586                 return CMD_WARNING;
587
588         switch (argv[1][0]) {
589         case 'a':
590                 mncc_answer(ms);
591                 break;
592         case 'h':
593                 if (argv[1][1] == 'a')
594                         mncc_hangup(ms);
595                 else
596                         mncc_hold(ms);
597                 break;
598         default:
599                 for (i = 0; i < strlen(argv[1]); i++) {
600                         /* allow international notation with + */
601                         if (i == 0 && argv[1][i] == '+')
602                                 continue;
603                         if (!(argv[1][i] >= '0' && argv[1][i] <= '9')
604                          && argv[1][i] != '*'
605                          && argv[1][i] != '#'
606                          && !(argv[1][i] >= 'a' && argv[1][i] <= 'c')) {
607                                 vty_out(vty, "Invalid digit '%c'%s", argv[1][i],
608                                         VTY_NEWLINE);
609                                 return CMD_WARNING;
610                         }
611                 }
612                 mncc_call(ms, (char *)argv[1]);
613         }
614
615         return CMD_SUCCESS;
616 }
617
618 DEFUN(call_retr, call_retr_cmd, "call MS_NAME retrieve [number]",
619         "Make a call\nName of MS (see \"show ms\")\n"
620         "Retrieve call on hold\nNumber of call to retrieve")
621 {
622         struct osmocom_ms *ms;
623
624         ms = get_ms(argv[0], vty);
625         if (!ms)
626                 return CMD_WARNING;
627
628         mncc_retrieve(ms, (argc > 1) ? atoi(argv[1]) : 0);
629
630         return CMD_SUCCESS;
631 }
632
633 DEFUN(network_show, network_show_cmd, "network show MS_NAME",
634         "Network ...\nShow results of network search (again)\n"
635         "Name of MS (see \"show ms\")")
636 {
637         struct osmocom_ms *ms;
638         struct gsm322_plmn *plmn;
639         struct gsm322_plmn_list *temp;
640
641         ms = get_ms(argv[0], vty);
642         if (!ms)
643                 return CMD_WARNING;
644         plmn = &ms->plmn;
645
646         if (ms->settings.plmn_mode != PLMN_MODE_AUTO
647          && plmn->state != GSM322_M3_NOT_ON_PLMN) {
648                 vty_out(vty, "Start network search first!%s", VTY_NEWLINE);
649                 return CMD_WARNING;
650         }
651
652         llist_for_each_entry(temp, &plmn->sorted_plmn, entry)
653                 vty_out(vty, " Network %s, %s (%s, %s)%s",
654                         gsm_print_mcc(temp->mcc), gsm_print_mnc(temp->mnc),
655                         gsm_get_mcc(temp->mcc),
656                         gsm_get_mnc(temp->mcc, temp->mnc), VTY_NEWLINE);
657
658         return CMD_SUCCESS;
659 }
660
661 DEFUN(network_search, network_search_cmd, "network search MS_NAME",
662         "Network ...\nTrigger network search\nName of MS (see \"show ms\")")
663 {
664         struct osmocom_ms *ms;
665         struct msgb *nmsg;
666
667         ms = get_ms(argv[0], vty);
668         if (!ms)
669                 return CMD_WARNING;
670
671         nmsg = gsm322_msgb_alloc(GSM322_EVENT_USER_RESEL);
672         if (!nmsg)
673                 return CMD_WARNING;
674         gsm322_plmn_sendmsg(ms, nmsg);
675
676         return CMD_SUCCESS;
677 }
678
679 DEFUN(cfg_gps_enable, cfg_gps_enable_cmd, "gps enable",
680         "GPS receiver")
681 {
682         if (gps_open()) {
683                 gps.enable = 1;
684                 vty_out(vty, "Failed to open GPS device!%s", VTY_NEWLINE);
685                 return CMD_WARNING;
686         }
687         gps.enable = 1;
688
689         return CMD_SUCCESS;
690 }
691
692 DEFUN(cfg_no_gps_enable, cfg_no_gps_enable_cmd, "no gps enable",
693         NO_STR "Disable GPS receiver")
694 {
695         if (gps.enable)
696                 gps_close();
697         gps.enable = 0;
698
699         return CMD_SUCCESS;
700 }
701
702 DEFUN(cfg_gps_device, cfg_gps_device_cmd, "gps device DEVICE",
703         "GPS receiver\nSelect serial device\n"
704         "Full path of serial device including /dev/")
705 {
706         strncpy(gps.device, argv[0], sizeof(gps.device));
707         gps.device[sizeof(gps.device) - 1] = '\0';
708         if (gps.enable) {
709                 gps_close();
710                 if (gps_open()) {
711                         vty_out(vty, "Failed to open GPS device!%s",
712                                 VTY_NEWLINE);
713                         return CMD_WARNING;
714                 }
715         }
716
717         return CMD_SUCCESS;
718 }
719
720 DEFUN(cfg_gps_baud, cfg_gps_baud_cmd, "gps baudrate "
721         "(default|4800|""9600|19200|38400|57600|115200)",
722         "GPS receiver\nSelect baud rate\nDefault, don't modify\n\n\n\n\n\n")
723 {
724         if (argv[0][0] == 'd')
725                 gps.baud = 0;
726         else
727                 gps.baud = atoi(argv[0]);
728         if (gps.enable) {
729                 gps_close();
730                 if (gps_open()) {
731                         gps.enable = 0;
732                         vty_out(vty, "Failed to open GPS device!%s",
733                                 VTY_NEWLINE);
734                         return CMD_WARNING;
735                 }
736         }
737
738         return CMD_SUCCESS;
739 }
740
741 /* per MS config */
742 DEFUN(cfg_ms, cfg_ms_cmd, "ms MS_NAME",
743         "Select a mobile station to configure\nName of MS (see \"show ms\")")
744 {
745         struct osmocom_ms *ms;
746
747         ms = get_ms(argv[0], vty);
748         if (!ms)
749                 return CMD_WARNING;
750
751         vty->index = ms;
752         vty->node = MS_NODE;
753
754         return CMD_SUCCESS;
755 }
756
757 static void config_write_ms_single(struct vty *vty, struct osmocom_ms *ms)
758 {
759         struct gsm_support *sup = &ms->support;
760         struct gsm_settings *set = &ms->settings;
761
762         vty_out(vty, "ms %s%s", ms->name, VTY_NEWLINE);
763         switch(set->sim_type) {
764                 case GSM_SIM_TYPE_NONE:
765                 vty_out(vty, " sim none%s", VTY_NEWLINE);
766                 break;
767                 case GSM_SIM_TYPE_READER:
768                 vty_out(vty, " sim reader%s", VTY_NEWLINE);
769                 break;
770                 case GSM_SIM_TYPE_TEST:
771                 vty_out(vty, " sim test%s", VTY_NEWLINE);
772                 break;
773         }
774         vty_out(vty, " network-selection-mode %s%s", (set->plmn_mode
775                         == PLMN_MODE_AUTO) ? "auto" : "manual", VTY_NEWLINE);
776         vty_out(vty, " imei %s %s%s", set->imei,
777                 set->imeisv + strlen(set->imei), VTY_NEWLINE);
778         if (set->imei_random)
779                 vty_out(vty, " imei-random %d%s", set->imei_random,
780                         VTY_NEWLINE);
781         else
782                 vty_out(vty, " imei-fixed%s", VTY_NEWLINE);
783         if (set->emergency_imsi[0])
784                 vty_out(vty, " emergency-imsi %s%s", set->emergency_imsi,
785                         VTY_NEWLINE);
786         else
787                 vty_out(vty, " no emergency-imsi%s", VTY_NEWLINE);
788         vty_out(vty, " %scall-waiting%s", (set->cw) ? "" : "no ", VTY_NEWLINE);
789         vty_out(vty, " %sclip%s", (set->clip) ? "" : "no ", VTY_NEWLINE);
790         vty_out(vty, " %sclir%s", (set->clir) ? "" : "no ", VTY_NEWLINE);
791         vty_out(vty, " test-sim%s", VTY_NEWLINE);
792         vty_out(vty, "  imsi %s%s", set->test_imsi, VTY_NEWLINE);
793         switch (set->test_ki_type) {
794         case GSM_SIM_KEY_XOR:
795                 vty_out(vty, "  ki xor %s%s", hexdump(set->test_ki, 12),
796                         VTY_NEWLINE);
797                 break;
798         case GSM_SIM_KEY_COMP128:
799                 vty_out(vty, "  ki comp128 %s%s", hexdump(set->test_ki, 16),
800                         VTY_NEWLINE);
801                 break;
802         }
803         vty_out(vty, "  %sbarred-access%s", (set->test_barr) ? "" : "no ",
804                 VTY_NEWLINE);
805         if (set->test_rplmn_valid)
806                 vty_out(vty, "  rplmn %s %s%s",
807                         gsm_print_mcc(set->test_rplmn_mcc),
808                         gsm_print_mnc(set->test_rplmn_mnc),
809                         VTY_NEWLINE);
810         else
811                 vty_out(vty, "  no rplmn%s", VTY_NEWLINE);
812         vty_out(vty, "  hplmn-search %s%s", (set->test_always) ? "everywhere"
813                         : "foreign-country", VTY_NEWLINE);
814         vty_out(vty, " exit%s", VTY_NEWLINE);
815         if (set->alter_tx_power)
816                 if (set->alter_tx_power_value)
817                         vty_out(vty, " tx-power %d%s",
818                                 set->alter_tx_power_value, VTY_NEWLINE);
819                 else
820                         vty_out(vty, " tx-power full%s", VTY_NEWLINE);
821         else
822                 vty_out(vty, " tx-power auto%s", VTY_NEWLINE);
823         if (set->alter_delay)
824                 vty_out(vty, " simulated-delay %d%s", set->alter_delay,
825                         VTY_NEWLINE);
826         else
827                 vty_out(vty, " no simulated-delay%s", VTY_NEWLINE);
828         if (set->stick)
829                 vty_out(vty, " stick %d%s", set->stick_arfcn,
830                         VTY_NEWLINE);
831         else
832                 vty_out(vty, " no stick%s", VTY_NEWLINE);
833         if (set->no_lupd)
834                 vty_out(vty, " no location-updating%s", VTY_NEWLINE);
835         else
836                 vty_out(vty, " location-updating%s", VTY_NEWLINE);
837         if (sup->full_v1 || sup->full_v2 || sup->full_v3) {
838                 /* mandatory anyway */
839                 vty_out(vty, " codec full-speed%s%s",
840                         (!set->half_prefer) ? " prefer" : "",
841                         VTY_NEWLINE);
842         }
843         if (sup->half_v1 || sup->half_v3) {
844                 if (set->half)
845                         vty_out(vty, " codec half-speed%s%s",
846                                 (set->half_prefer) ? " prefer" : "",
847                                 VTY_NEWLINE);
848                 else
849                         vty_out(vty, " no codec half-speed%s", VTY_NEWLINE);
850         }
851         vty_out(vty, "exit%s", VTY_NEWLINE);
852         vty_out(vty, "!%s", VTY_NEWLINE);
853 }
854
855 static int config_write_ms(struct vty *vty)
856 {
857         struct osmocom_ms *ms;
858
859         vty_out(vty, "gps device %s%s", gps.device, VTY_NEWLINE);
860         if (gps.baud)
861                 vty_out(vty, "gps baudrate %d%s", gps.baud, VTY_NEWLINE);
862         else
863                 vty_out(vty, "gps baudrate default%s", VTY_NEWLINE);
864         vty_out(vty, "%sgps enable%s", (gps.enable) ? "" : "no ", VTY_NEWLINE);
865         vty_out(vty, "!%s", VTY_NEWLINE);
866
867         llist_for_each_entry(ms, &ms_list, entity)
868                 config_write_ms_single(vty, ms);
869
870         return CMD_SUCCESS;
871 }
872
873 DEFUN(cfg_ms_sim, cfg_ms_sim_cmd, "sim (none|reader|test)",
874         "Set SIM card type when powering on\nNo SIM interted\n"
875         "Use SIM from reader\nTest SIM inserted")
876 {
877         struct osmocom_ms *ms = vty->index;
878
879         switch (argv[0][0]) {
880         case 'n':
881                 ms->settings.sim_type = GSM_SIM_TYPE_NONE;
882                 break;
883         case 'r':
884                 ms->settings.sim_type = GSM_SIM_TYPE_READER;
885                 break;
886         case 't':
887                 ms->settings.sim_type = GSM_SIM_TYPE_TEST;
888                 break;
889         default:
890                 vty_out(vty, "unknown SIM type%s", VTY_NEWLINE);
891                 return CMD_WARNING;
892         }
893
894         return CMD_SUCCESS;
895 }
896
897 DEFUN(cfg_ms_mode, cfg_ms_mode_cmd, "network-selection-mode (auto|manual)",
898         "Set network selection mode\nAutomatic network selection\n"
899         "Manual network selection")
900 {
901         struct osmocom_ms *ms = vty->index;
902         struct msgb *nmsg;
903
904         if (!ms->plmn.state) {
905                 if (argv[0][0] == 'a')
906                         ms->settings.plmn_mode = PLMN_MODE_AUTO;
907                 else
908                         ms->settings.plmn_mode = PLMN_MODE_MANUAL;
909
910                 return CMD_SUCCESS;
911         }
912         if (argv[0][0] == 'a')
913                 nmsg = gsm322_msgb_alloc(GSM322_EVENT_SEL_AUTO);
914         else
915                 nmsg = gsm322_msgb_alloc(GSM322_EVENT_SEL_MANUAL);
916         if (!nmsg)
917                 return CMD_WARNING;
918         gsm322_plmn_sendmsg(ms, nmsg);
919
920         return CMD_SUCCESS;
921 }
922
923 DEFUN(cfg_ms_imei, cfg_ms_imei_cmd, "imei IMEI [SV]",
924         "Set IMEI (enter without control digit)\n15 Digits IMEI\n"
925         "Software version digit")
926 {
927         struct osmocom_ms *ms = vty->index;
928         char *error, *sv = "0";
929
930         if (argc >= 2)
931                 sv = (char *)argv[1];
932
933         error = gsm_check_imei(argv[0], sv);
934         if (error) {
935                 vty_out(vty, "%s%s", error, VTY_NEWLINE);
936                 return CMD_WARNING;
937         }
938
939         strcpy(ms->settings.imei, argv[0]);
940         strcpy(ms->settings.imeisv, argv[0]);
941         strcpy(ms->settings.imeisv + 15, sv);
942
943         return CMD_SUCCESS;
944 }
945
946 DEFUN(cfg_ms_imei_fixed, cfg_ms_imei_fixed_cmd, "imei-fixed",
947         "Use fixed IMEI on every power on")
948 {
949         struct osmocom_ms *ms = vty->index;
950
951         ms->settings.imei_random = 0;
952
953         return CMD_SUCCESS;
954 }
955
956 DEFUN(cfg_ms_imei_random, cfg_ms_imei_random_cmd, "imei-random <0-15>",
957         "Use random IMEI on every power on\n"
958         "Number of trailing digits to randomize")
959 {
960         struct osmocom_ms *ms = vty->index;
961
962         ms->settings.imei_random = atoi(argv[0]);
963
964         return CMD_SUCCESS;
965 }
966
967 DEFUN(cfg_ms_emerg_imsi, cfg_ms_emerg_imsi_cmd, "emergency-imsi IMSI",
968         "Use special IMSI for emergency calls\n15 digits IMSI")
969 {
970         struct osmocom_ms *ms = vty->index;
971         char *error;
972
973         error = gsm_check_imsi(argv[0]);
974         if (error) {
975                 vty_out(vty, "%s%s", error, VTY_NEWLINE);
976                 return CMD_WARNING;
977         }
978         strcpy(ms->settings.emergency_imsi, argv[0]);
979
980         return CMD_SUCCESS;
981 }
982
983 DEFUN(cfg_ms_no_emerg_imsi, cfg_ms_no_emerg_imsi_cmd, "no emergency-imsi",
984         NO_STR "Use IMSI of SIM or IMEI for emergency calls")
985 {
986         struct osmocom_ms *ms = vty->index;
987
988         ms->settings.emergency_imsi[0] = '\0';
989
990         return CMD_SUCCESS;
991 }
992
993 DEFUN(cfg_no_cw, cfg_ms_no_cw_cmd, "no call-waiting",
994         NO_STR "Disallow waiting calls")
995 {
996         struct osmocom_ms *ms = vty->index;
997
998         ms->settings.cw = 0;
999
1000         return CMD_SUCCESS;
1001 }
1002
1003 DEFUN(cfg_cw, cfg_ms_cw_cmd, "call-waiting",
1004         "Allow waiting calls")
1005 {
1006         struct osmocom_ms *ms = vty->index;
1007
1008         ms->settings.cw = 1;
1009
1010         return CMD_SUCCESS;
1011 }
1012
1013 DEFUN(cfg_clip, cfg_ms_clip_cmd, "clip",
1014         "Force caller ID presentation")
1015 {
1016         struct osmocom_ms *ms = vty->index;
1017
1018         ms->settings.clip = 1;
1019         ms->settings.clir = 0;
1020
1021         return CMD_SUCCESS;
1022 }
1023
1024 DEFUN(cfg_clir, cfg_ms_clir_cmd, "clir",
1025         "Force caller ID restriction")
1026 {
1027         struct osmocom_ms *ms = vty->index;
1028
1029         ms->settings.clip = 0;
1030         ms->settings.clir = 1;
1031
1032         return CMD_SUCCESS;
1033 }
1034
1035 DEFUN(cfg_no_clip, cfg_ms_no_clip_cmd, "no clip",
1036         NO_STR "Disable forcing of caller ID presentation")
1037 {
1038         struct osmocom_ms *ms = vty->index;
1039
1040         ms->settings.clip = 0;
1041
1042         return CMD_SUCCESS;
1043 }
1044
1045 DEFUN(cfg_no_clir, cfg_ms_no_clir_cmd, "no clir",
1046         NO_STR "Disable forcing of caller ID restriction")
1047 {
1048         struct osmocom_ms *ms = vty->index;
1049
1050         ms->settings.clir = 0;
1051
1052         return CMD_SUCCESS;
1053 }
1054
1055 DEFUN(cfg_ms_tx_power, cfg_ms_tx_power_cmd, "tx-power (auto|full)",
1056         "Set the way to choose transmit power\nControlled by BTS\n"
1057         "Always full power\nFixed GSM power value if supported")
1058 {
1059         struct osmocom_ms *ms = vty->index;
1060
1061         switch (argv[0][0]) {
1062         case 'a':
1063                 ms->settings.alter_tx_power = 0;
1064                 break;
1065         case 'f':
1066                 ms->settings.alter_tx_power = 1;
1067                 ms->settings.alter_tx_power_value = 0;
1068                 break;
1069         }
1070
1071         return CMD_SUCCESS;
1072 }
1073
1074 DEFUN(cfg_ms_tx_power_val, cfg_ms_tx_power_val_cmd, "tx-power <0-31>",
1075         "Set the way to choose transmit power\n"
1076         "Fixed GSM power value if supported")
1077 {
1078         struct osmocom_ms *ms = vty->index;
1079
1080         ms->settings.alter_tx_power = 1;
1081         ms->settings.alter_tx_power_value = atoi(argv[0]);
1082
1083         return CMD_SUCCESS;
1084 }
1085
1086 DEFUN(cfg_ms_sim_delay, cfg_ms_sim_delay_cmd, "simulated-delay <-128-127>",
1087         "Simulate a lower or higher distance from the BTS\n"
1088         "Delay in half bits (distance in 553.85 meter steps)")
1089 {
1090         struct osmocom_ms *ms = vty->index;
1091
1092         ms->settings.alter_delay = atoi(argv[0]);
1093
1094         return CMD_SUCCESS;
1095 }
1096
1097 DEFUN(cfg_ms_no_sim_delay, cfg_ms_no_sim_delay_cmd, "no simulated-delay",
1098         NO_STR "Do not simulate a lower or higher distance from the BTS")
1099 {
1100         struct osmocom_ms *ms = vty->index;
1101
1102         ms->settings.alter_delay = 0;
1103
1104         return CMD_SUCCESS;
1105 }
1106
1107 DEFUN(cfg_ms_stick, cfg_ms_stick_cmd, "stick <0-1023>",
1108         "Stick to the given cell\nARFCN of the cell to stick to")
1109 {
1110         struct osmocom_ms *ms = vty->index;
1111
1112         ms->settings.stick = 1;
1113         ms->settings.stick_arfcn = atoi(argv[0]);
1114
1115         return CMD_SUCCESS;
1116 }
1117
1118 DEFUN(cfg_ms_no_stick, cfg_ms_no_stick_cmd, "no stick",
1119         NO_STR "Do not stick to any cell")
1120 {
1121         struct osmocom_ms *ms = vty->index;
1122
1123         ms->settings.stick = 0;
1124
1125         return CMD_SUCCESS;
1126 }
1127
1128 DEFUN(cfg_ms_lupd, cfg_ms_lupd_cmd, "location-updating",
1129         "Allow location updating")
1130 {
1131         struct osmocom_ms *ms = vty->index;
1132
1133         ms->settings.no_lupd = 0;
1134
1135         return CMD_SUCCESS;
1136 }
1137
1138 DEFUN(cfg_ms_no_lupd, cfg_ms_no_lupd_cmd, "no location-updating",
1139         NO_STR "Do not allow location updating")
1140 {
1141         struct osmocom_ms *ms = vty->index;
1142
1143         ms->settings.no_lupd = 1;
1144
1145         return CMD_SUCCESS;
1146 }
1147
1148 DEFUN(cfg_codec_full, cfg_ms_codec_full_cmd, "codec full-speed",
1149         "Enable codec\nFull speed speech codec")
1150 {
1151         struct osmocom_ms *ms = vty->index;
1152         struct gsm_support *sup = &ms->support;
1153
1154         if (!sup->full_v1 && !sup->full_v2 && !sup->full_v3) {
1155                 vty_out(vty, "Full-rate codec not supported%s", VTY_NEWLINE);
1156                 return CMD_WARNING;
1157         }
1158
1159         return CMD_SUCCESS;
1160 }
1161
1162 DEFUN(cfg_codec_full_pref, cfg_ms_codec_full_pref_cmd, "codec full-speed "
1163         "prefer",
1164         "Enable codec\nFull speed speech codec\nPrefer this codec")
1165 {
1166         struct osmocom_ms *ms = vty->index;
1167         struct gsm_support *sup = &ms->support;
1168
1169         if (!sup->full_v1 && !sup->full_v2 && !sup->full_v3) {
1170                 vty_out(vty, "Full-rate codec not supported%s", VTY_NEWLINE);
1171                 return CMD_WARNING;
1172         }
1173
1174         ms->settings.half_prefer = 0;
1175
1176         return CMD_SUCCESS;
1177 }
1178
1179 DEFUN(cfg_codec_half, cfg_ms_codec_half_cmd, "codec half-speed",
1180         "Enable codec\nHalf speed speech codec")
1181 {
1182         struct osmocom_ms *ms = vty->index;
1183         struct gsm_support *sup = &ms->support;
1184
1185         if (!sup->half_v1 && !sup->half_v3) {
1186                 vty_out(vty, "Half-rate codec not supported%s", VTY_NEWLINE);
1187                 return CMD_WARNING;
1188         }
1189
1190         ms->settings.half = 1;
1191
1192         return CMD_SUCCESS;
1193 }
1194
1195 DEFUN(cfg_codec_half_pref, cfg_ms_codec_half_pref_cmd, "codec half-speed "
1196         "prefer",
1197         "Enable codec\nHalf speed speech codec\nPrefer this codec")
1198 {
1199         struct osmocom_ms *ms = vty->index;
1200         struct gsm_support *sup = &ms->support;
1201
1202         if (!sup->half_v1 && !sup->half_v3) {
1203                 vty_out(vty, "Half-rate codec not supported%s", VTY_NEWLINE);
1204                 return CMD_WARNING;
1205         }
1206
1207         ms->settings.half = 1;
1208         ms->settings.half_prefer = 1;
1209
1210         return CMD_SUCCESS;
1211 }
1212
1213 DEFUN(cfg_no_codec_half, cfg_ms_no_codec_half_cmd, "no codec half-speed",
1214         NO_STR "Disable codec\nHalf speed speech codec")
1215 {
1216         struct osmocom_ms *ms = vty->index;
1217         struct gsm_support *sup = &ms->support;
1218
1219         if (!sup->half_v1 && !sup->half_v3) {
1220                 vty_out(vty, "Half-rate codec not supported%s", VTY_NEWLINE);
1221                 return CMD_WARNING;
1222         }
1223
1224         ms->settings.half = 0;
1225         ms->settings.half_prefer = 0;
1226
1227         return CMD_SUCCESS;
1228 }
1229
1230 /* per testsim config */
1231 DEFUN(cfg_ms_testsim, cfg_ms_testsim_cmd, "test-sim",
1232         "Configure test SIM emulation")
1233 {
1234         vty->node = TESTSIM_NODE;
1235
1236         return CMD_SUCCESS;
1237 }
1238
1239 static int config_write_dummy(struct vty *vty)
1240 {
1241         return CMD_SUCCESS;
1242 }
1243
1244 DEFUN(cfg_test_imsi, cfg_test_imsi_cmd, "imsi IMSI",
1245         "Set IMSI on test card\n15 digits IMSI")
1246 {
1247         struct osmocom_ms *ms = vty->index;
1248         char *error = gsm_check_imsi(argv[0]);
1249
1250         if (error) {
1251                 vty_out(vty, "%s%s", error, VTY_NEWLINE);
1252                 return CMD_WARNING;
1253         }
1254
1255         strcpy(ms->settings.test_imsi, argv[0]);
1256
1257         return CMD_SUCCESS;
1258 }
1259
1260 #define HEX_STR "\nByte as two digits hexadecimal"
1261 DEFUN(cfg_test_ki_xor, cfg_test_ki_xor_cmd, "ki xor HEX HEX HEX HEX HEX HEX "
1262         "HEX HEX HEX HEX HEX HEX",
1263         "Set Key (Kc) on test card\nUse XOR algorithm" HEX_STR HEX_STR HEX_STR
1264         HEX_STR HEX_STR HEX_STR HEX_STR HEX_STR HEX_STR HEX_STR HEX_STR HEX_STR)
1265 {
1266         struct osmocom_ms *ms = vty->index;
1267         struct gsm_settings *set = &ms->settings;
1268         uint8_t ki[12];
1269         const char *p;
1270         int i;
1271
1272         for (i = 0; i < 12; i++) {
1273                 p = argv[i];
1274                 if (!strncmp(p, "0x", 2))
1275                         p += 2;
1276                 if (strlen(p) != 2) {
1277                         vty_out(vty, "Expecting two digits hex value (with or "
1278                                 "without 0x in front)%s", VTY_NEWLINE);
1279                         return CMD_WARNING;
1280                 }
1281                 ki[i] = strtoul(p, NULL, 16);
1282         }
1283
1284         set->test_ki_type = GSM_SIM_KEY_XOR;
1285         memcpy(set->test_ki, ki, 12);
1286         return CMD_SUCCESS;
1287 }
1288
1289 DEFUN(cfg_test_ki_comp128, cfg_test_ki_comp128_cmd, "ki comp128 HEX HEX HEX "
1290         "HEX HEX HEX HEX HEX HEX HEX HEX HEX HEX HEX HEX HEX",
1291         "Set Key (Kc) on test card\nUse XOR algorithm" HEX_STR HEX_STR HEX_STR
1292         HEX_STR HEX_STR HEX_STR HEX_STR HEX_STR HEX_STR HEX_STR HEX_STR HEX_STR
1293         HEX_STR HEX_STR HEX_STR HEX_STR)
1294 {
1295         struct osmocom_ms *ms = vty->index;
1296         struct gsm_settings *set = &ms->settings;
1297         uint8_t ki[16];
1298         const char *p;
1299         int i;
1300
1301         for (i = 0; i < 16; i++) {
1302                 p = argv[i];
1303                 if (!strncmp(p, "0x", 2))
1304                         p += 2;
1305                 if (strlen(p) != 2) {
1306                         vty_out(vty, "Expecting two digits hex value (with or "
1307                                 "without 0x in front)%s", VTY_NEWLINE);
1308                         return CMD_WARNING;
1309                 }
1310                 ki[i] = strtoul(p, NULL, 16);
1311         }
1312
1313         set->test_ki_type = GSM_SIM_KEY_COMP128;
1314         memcpy(set->test_ki, ki, 16);
1315         return CMD_SUCCESS;
1316 }
1317
1318 DEFUN(cfg_test_barr, cfg_test_barr_cmd, "barred-access",
1319         "Allow access to barred cells")
1320 {
1321         struct osmocom_ms *ms = vty->index;
1322
1323         ms->settings.test_barr = 1;
1324
1325         return CMD_SUCCESS;
1326 }
1327
1328 DEFUN(cfg_test_no_barr, cfg_test_no_barr_cmd, "no barred-access",
1329         NO_STR "Deny access to barred cells")
1330 {
1331         struct osmocom_ms *ms = vty->index;
1332
1333         ms->settings.test_barr = 0;
1334
1335         return CMD_SUCCESS;
1336 }
1337
1338 DEFUN(cfg_test_no_rplmn, cfg_test_no_rplmn_cmd, "no rplmn",
1339         NO_STR "Unset Registered PLMN")
1340 {
1341         struct osmocom_ms *ms = vty->index;
1342
1343         ms->settings.test_rplmn_valid = 0;
1344
1345         return CMD_SUCCESS;
1346 }
1347
1348 DEFUN(cfg_test_rplmn, cfg_test_rplmn_cmd, "rplmn MCC MNC",
1349         "Set Registered PLMN\nMobile Country Code\nMobile Network Code")
1350 {
1351         struct osmocom_ms *ms = vty->index;
1352         uint16_t mcc = gsm_input_mcc((char *)argv[0]),
1353                  mnc = gsm_input_mnc((char *)argv[1]);
1354
1355         if (!mcc) {
1356                 vty_out(vty, "Given MCC invalid%s", VTY_NEWLINE);
1357                 return CMD_WARNING;
1358         }
1359         if (!mnc) {
1360                 vty_out(vty, "Given MNC invalid%s", VTY_NEWLINE);
1361                 return CMD_WARNING;
1362         }
1363         ms->settings.test_rplmn_valid = 1;
1364         ms->settings.test_rplmn_mcc = mcc;
1365         ms->settings.test_rplmn_mnc = mnc;
1366
1367         return CMD_SUCCESS;
1368 }
1369
1370 DEFUN(cfg_test_hplmn, cfg_test_hplmn_cmd, "hplmn-search (everywhere|foreign-country)",
1371         "Set Home PLMN search mode\n"
1372         "Search for HPLMN when on any other network\n"
1373         "Search for HPLMN when in a different country")
1374 {
1375         struct osmocom_ms *ms = vty->index;
1376
1377         switch (argv[0][0]) {
1378         case 'e':
1379                 ms->settings.test_always = 1;
1380                 break;
1381         case 'f':
1382                 ms->settings.test_always = 0;
1383                 break;
1384         }
1385
1386         return CMD_SUCCESS;
1387 }
1388
1389 enum node_type ms_vty_go_parent(struct vty *vty)
1390 {
1391         switch (vty->node) {
1392         case MS_NODE:
1393                 vty->node = CONFIG_NODE;
1394                 vty->index = NULL;
1395                 break;
1396         case TESTSIM_NODE:
1397                 vty->node = MS_NODE;
1398                 break;
1399         default:
1400                 vty->node = CONFIG_NODE;
1401         }
1402
1403         return vty->node;
1404 }
1405
1406 /* Down vty node level. */
1407 gDEFUN(ournode_exit,
1408        ournode_exit_cmd, "exit", "Exit current mode and down to previous mode\n")
1409 {
1410         switch (vty->node) {
1411         case MS_NODE:
1412                 vty->node = CONFIG_NODE;
1413                 vty->index = NULL;
1414                 break;
1415         case TESTSIM_NODE:
1416                 vty->node = MS_NODE;
1417                 break;
1418         default:
1419                 break;
1420         }
1421         return CMD_SUCCESS;
1422 }
1423
1424 /* End of configuration. */
1425 gDEFUN(ournode_end,
1426        ournode_end_cmd, "end", "End current mode and change to enable mode.")
1427 {
1428         switch (vty->node) {
1429         case VIEW_NODE:
1430         case ENABLE_NODE:
1431                 /* Nothing to do. */
1432                 break;
1433         case CONFIG_NODE:
1434         case VTY_NODE:
1435         case MS_NODE:
1436         case TESTSIM_NODE:
1437                 vty_config_unlock(vty);
1438                 vty->node = ENABLE_NODE;
1439                 vty->index = NULL;
1440                 vty->index_sub = NULL;
1441                 break;
1442         default:
1443                 break;
1444         }
1445         return CMD_SUCCESS;
1446 }
1447
1448 int ms_vty_init(void)
1449 {
1450         install_element_ve(&show_ms_cmd);
1451         install_element_ve(&show_subscr_cmd);
1452         install_element_ve(&show_support_cmd);
1453         install_element_ve(&show_states_cmd);
1454         install_element_ve(&show_cell_cmd);
1455         install_element_ve(&show_cell_si_cmd);
1456         install_element_ve(&show_ba_cmd);
1457         install_element_ve(&show_forb_la_cmd);
1458         install_element_ve(&show_forb_plmn_cmd);
1459         install_element_ve(&monitor_network_cmd);
1460         install_element_ve(&no_monitor_network_cmd);
1461
1462         install_element(ENABLE_NODE, &sim_test_cmd);
1463         install_element(ENABLE_NODE, &sim_reader_cmd);
1464         install_element(ENABLE_NODE, &sim_remove_cmd);
1465         install_element(ENABLE_NODE, &sim_pin_cmd);
1466         install_element(ENABLE_NODE, &sim_disable_pin_cmd);
1467         install_element(ENABLE_NODE, &sim_enable_pin_cmd);
1468         install_element(ENABLE_NODE, &sim_change_pin_cmd);
1469         install_element(ENABLE_NODE, &sim_unblock_pin_cmd);
1470         install_element(ENABLE_NODE, &network_search_cmd);
1471         install_element(ENABLE_NODE, &network_show_cmd);
1472         install_element(ENABLE_NODE, &network_select_cmd);
1473         install_element(ENABLE_NODE, &call_cmd);
1474         install_element(ENABLE_NODE, &call_retr_cmd);
1475
1476         install_element(CONFIG_NODE, &cfg_gps_device_cmd);
1477         install_element(CONFIG_NODE, &cfg_gps_baud_cmd);
1478         install_element(CONFIG_NODE, &cfg_gps_enable_cmd);
1479         install_element(CONFIG_NODE, &cfg_no_gps_enable_cmd);
1480
1481         install_element(CONFIG_NODE, &cfg_ms_cmd);
1482         install_element(CONFIG_NODE, &ournode_end_cmd);
1483         install_node(&ms_node, config_write_ms);
1484         install_default(MS_NODE);
1485         install_element(MS_NODE, &ournode_exit_cmd);
1486         install_element(MS_NODE, &ournode_end_cmd);
1487         install_element(MS_NODE, &cfg_ms_sim_cmd);
1488         install_element(MS_NODE, &cfg_ms_mode_cmd);
1489         install_element(MS_NODE, &cfg_ms_imei_cmd);
1490         install_element(MS_NODE, &cfg_ms_imei_fixed_cmd);
1491         install_element(MS_NODE, &cfg_ms_imei_random_cmd);
1492         install_element(MS_NODE, &cfg_ms_no_emerg_imsi_cmd);
1493         install_element(MS_NODE, &cfg_ms_emerg_imsi_cmd);
1494         install_element(MS_NODE, &cfg_ms_cw_cmd);
1495         install_element(MS_NODE, &cfg_ms_no_cw_cmd);
1496         install_element(MS_NODE, &cfg_ms_clip_cmd);
1497         install_element(MS_NODE, &cfg_ms_clir_cmd);
1498         install_element(MS_NODE, &cfg_ms_no_clip_cmd);
1499         install_element(MS_NODE, &cfg_ms_no_clir_cmd);
1500         install_element(MS_NODE, &cfg_ms_testsim_cmd);
1501         install_element(MS_NODE, &cfg_ms_tx_power_cmd);
1502         install_element(MS_NODE, &cfg_ms_tx_power_val_cmd);
1503         install_element(MS_NODE, &cfg_ms_sim_delay_cmd);
1504         install_element(MS_NODE, &cfg_ms_no_sim_delay_cmd);
1505         install_element(MS_NODE, &cfg_ms_stick_cmd);
1506         install_element(MS_NODE, &cfg_ms_no_stick_cmd);
1507         install_element(MS_NODE, &cfg_ms_lupd_cmd);
1508         install_element(MS_NODE, &cfg_ms_no_lupd_cmd);
1509         install_element(MS_NODE, &cfg_ms_codec_full_cmd);
1510         install_element(MS_NODE, &cfg_ms_codec_full_pref_cmd);
1511         install_element(MS_NODE, &cfg_ms_codec_half_cmd);
1512         install_element(MS_NODE, &cfg_ms_codec_half_pref_cmd);
1513         install_element(MS_NODE, &cfg_ms_no_codec_half_cmd);
1514         install_node(&testsim_node, config_write_dummy);
1515         install_default(TESTSIM_NODE);
1516         install_element(TESTSIM_NODE, &ournode_exit_cmd);
1517         install_element(TESTSIM_NODE, &ournode_end_cmd);
1518         install_element(TESTSIM_NODE, &cfg_test_imsi_cmd);
1519         install_element(TESTSIM_NODE, &cfg_test_ki_xor_cmd);
1520         install_element(TESTSIM_NODE, &cfg_test_ki_comp128_cmd);
1521         install_element(TESTSIM_NODE, &cfg_test_barr_cmd);
1522         install_element(TESTSIM_NODE, &cfg_test_no_barr_cmd);
1523         install_element(TESTSIM_NODE, &cfg_test_no_rplmn_cmd);
1524         install_element(TESTSIM_NODE, &cfg_test_rplmn_cmd);
1525         install_element(TESTSIM_NODE, &cfg_test_hplmn_cmd);
1526
1527         return 0;
1528 }
1529
1530 void vty_notify(struct osmocom_ms *ms, const char *fmt, ...)
1531 {
1532         struct telnet_connection *connection;
1533         char buffer[1000];
1534         va_list args;
1535         struct vty *vty;
1536
1537         if (fmt) {
1538                 va_start(args, fmt);
1539                 vsnprintf(buffer, sizeof(buffer) - 1, fmt, args);
1540                 buffer[sizeof(buffer) - 1] = '\0';
1541                 va_end(args);
1542
1543                 if (!buffer[0])
1544                         return;
1545         }
1546
1547         llist_for_each_entry(connection, &active_connections, entry) {
1548                 vty = connection->vty;
1549                 if (!vty)
1550                         continue;
1551                 if (!fmt) {
1552                         vty_out(vty, "%s%% (MS %s)%s", VTY_NEWLINE, ms->name,
1553                                 VTY_NEWLINE);
1554                         continue;
1555                 }
1556                 if (buffer[strlen(buffer) - 1] == '\n') {
1557                         buffer[strlen(buffer) - 1] = '\0';
1558                         vty_out(vty, "%% %s%s", buffer, VTY_NEWLINE);
1559                         buffer[strlen(buffer)] = '\n';
1560                 } else
1561                         vty_out(vty, "%% %s", buffer);
1562         }
1563 }
1564