1 /* "Application" code of the layer2/3 stack */
3 /* (C) 2010 by Holger Hans Peter Freyther
4 * (C) 2010 by Harald Welte <laforge@gnumonks.org>
5 * (C) 2010 by Andreas Eversberg <jolly@eversberg.eu>
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.
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.
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.
28 #include <osmocom/bb/common/osmocom_data.h>
29 #include <osmocom/bb/common/l1l2_interface.h>
30 #include <osmocom/bb/common/l1ctl.h>
31 #include <osmocom/bb/common/lapdm.h>
32 #include <osmocom/bb/common/logging.h>
33 #include <osmocom/bb/common/gps.h>
34 #include <osmocom/bb/mobile/gsm48_rr.h>
35 #include <osmocom/bb/mobile/vty.h>
36 #include <osmocom/bb/mobile/app_mobile.h>
37 #include <osmocom/bb/mobile/mncc.h>
38 #include <osmocom/vty/telnet_interface.h>
40 #include <osmocom/core/msgb.h>
41 #include <osmocom/core/talloc.h>
42 #include <osmocom/core/select.h>
43 #include <osmocom/core/signal.h>
46 extern struct llist_head ms_list;
47 extern int vty_reading;
49 int mncc_recv_mobile(struct osmocom_ms *ms, int msg_type, void *arg);
50 int mncc_recv_dummy(struct osmocom_ms *ms, int msg_type, void *arg);
51 int (*mncc_recv_app)(struct osmocom_ms *ms, int, void *);
54 /* handle ms instance */
55 int mobile_work(struct osmocom_ms *ms)
61 w |= gsm48_rsl_dequeue(ms);
62 w |= gsm48_rr_dequeue(ms);
63 w |= gsm48_mmxx_dequeue(ms);
64 w |= gsm48_mmr_dequeue(ms);
65 w |= gsm48_mmevent_dequeue(ms);
66 w |= gsm322_plmn_dequeue(ms);
67 w |= gsm322_cs_dequeue(ms);
68 w |= gsm_sim_job_dequeue(ms);
69 w |= mncc_dequeue(ms);
76 /* run ms instance, if layer1 is available */
77 int mobile_signal_cb(unsigned int subsys, unsigned int signal,
78 void *handler_data, void *signal_data)
80 struct osmocom_ms *ms;
81 struct gsm_settings *set;
84 if (subsys != SS_L1CTL)
95 /* insert test card, if enabled */
96 switch (set->sim_type) {
97 case GSM_SIM_TYPE_READER:
98 /* trigger sim card reader process */
99 gsm_subscr_simcard(ms);
101 case GSM_SIM_TYPE_TEST:
102 gsm_subscr_testcard(ms, set->test_rplmn_mcc,
103 set->test_rplmn_mnc, set->test_lac,
107 /* no SIM, trigger PLMN selection process */
108 nmsg = gsm322_msgb_alloc(GSM322_EVENT_SWITCH_ON);
111 gsm322_plmn_sendmsg(ms, nmsg);
112 nmsg = gsm322_msgb_alloc(GSM322_EVENT_SWITCH_ON);
115 gsm322_cs_sendmsg(ms, nmsg);
123 /* power-off ms instance */
124 int mobile_exit(struct osmocom_ms *ms, int force)
126 struct gsm48_mmlayer *mm = &ms->mmlayer;
128 if (!force && ms->started) {
131 ms->shutdown = 1; /* going down */
132 nmsg = gsm48_mmevent_msgb_alloc(GSM48_MM_EVENT_IMSI_DETACH);
135 gsm48_mmevent_msg(mm->ms, nmsg);
146 lapdm_channel_exit(&ms->lapdm_channel);
148 ms->shutdown = 2; /* being down */
149 vty_notify(ms, NULL);
150 vty_notify(ms, "Power off!\n");
151 printf("Power off! (MS %s)\n", ms->name);
156 /* power-on ms instance */
157 int mobile_init(struct osmocom_ms *ms)
161 gsm_settings_arfcn(ms);
162 ms->lapdm_channel.lapdm_dcch.l1_ctx = ms;
163 ms->lapdm_channel.lapdm_dcch.l3_ctx = ms;
164 ms->lapdm_channel.lapdm_acch.l1_ctx = ms;
165 ms->lapdm_channel.lapdm_acch.l3_ctx = ms;
166 lapdm_channel_init(&ms->lapdm_channel);
172 INIT_LLIST_HEAD(&ms->trans_list);
175 rc = layer2_open(ms, ms->settings.layer2_socket_path);
177 fprintf(stderr, "Failed during layer2_open()\n");
178 ms->l2_wq.bfd.fd = -1;
184 rc = sap_open(ms, ms->settings.sap_socket_path);
186 fprintf(stderr, "Failed during sap_open(), no SIM reader\n");
187 ms->sap_wq.bfd.fd = -1;
194 ms->cclayer.mncc_recv = mncc_recv_app;
195 else if (ms->settings.ch_cap == GSM_CAP_SDCCH)
196 ms->cclayer.mncc_recv = mncc_recv_dummy;
198 ms->cclayer.mncc_recv = mncc_recv_mobile;
200 gsm_random_imei(&ms->settings);
205 l1ctl_tx_reset_req(ms, L1CTL_RES_T_FULL);
206 printf("Mobile '%s' initialized, please start phone now!\n", ms->name);
210 /* create ms instance */
211 struct osmocom_ms *mobile_new(char *name)
213 static struct osmocom_ms *ms;
215 ms = talloc_zero(l23_ctx, struct osmocom_ms);
217 fprintf(stderr, "Failed to allocate MS\n");
220 llist_add_tail(&ms->entity, &ms_list);
222 strcpy(ms->name, name);
224 ms->l2_wq.bfd.fd = -1;
225 ms->sap_wq.bfd.fd = -1;
227 gsm_support_init(ms);
228 gsm_settings_init(ms);
230 ms->shutdown = 2; /* being down */
235 msg = msgb_alloc(sizeof(struct gsm_mncc), "MNCC");
237 struct gsm_mncc *mncc = (struct gsm_mncc *)msg->data;
239 mncc->msg_type = MS_NEW;
240 mncc_recv_app(ms, mncc->msg_type, mncc);
242 ms->cclayer.mncc_recv = mncc_recv_app;
244 ms->cclayer.mncc_recv = mncc_recv_dummy;
249 /* destroy ms instance */
250 int mobile_delete(struct osmocom_ms *ms, int force)
256 if (ms->shutdown == 0 || (ms->shutdown == 1 && force)) {
257 rc = mobile_exit(ms, force);
265 msg = msgb_alloc(sizeof(struct gsm_mncc), "MNCC");
267 struct gsm_mncc *mncc = (struct gsm_mncc *)msg->data;
269 mncc->msg_type = MS_DELETE;
270 mncc_recv_app(ms, mncc->msg_type, mncc);
277 /* handle global shutdown */
278 int global_signal_cb(unsigned int subsys, unsigned int signal,
279 void *handler_data, void *signal_data)
281 struct osmocom_ms *ms, *ms2;
283 if (subsys != SS_GLOBAL)
287 case S_GLOBAL_SHUTDOWN:
288 llist_for_each_entry_safe(ms, ms2, &ms_list, entity)
289 mobile_delete(ms, quit);
291 /* if second signal is received, force to exit */
298 /* global work handler */
299 int l23_app_work(int *_quit)
301 struct osmocom_ms *ms, *ms2;
304 llist_for_each_entry_safe(ms, ms2, &ms_list, entity) {
305 if (ms->shutdown != 2)
306 work |= mobile_work(ms);
307 if (ms->shutdown == 2) {
308 if (ms->l2_wq.bfd.fd > -1) {
310 ms->l2_wq.bfd.fd = -1;
313 if (ms->sap_wq.bfd.fd > -1) {
315 ms->sap_wq.bfd.fd = -1;
319 gsm_settings_exit(ms);
320 llist_del(&ms->entity);
327 /* return, if a shutdown was scheduled (quit = 1) */
333 int l23_app_exit(void)
335 osmo_signal_unregister_handler(SS_L1CTL, &gsm322_l1_signal, NULL);
336 osmo_signal_unregister_handler(SS_L1CTL, &mobile_signal_cb, NULL);
337 osmo_signal_unregister_handler(SS_GLOBAL, &global_signal_cb, NULL);
344 static struct vty_app_info vty_info = {
346 .version = PACKAGE_VERSION,
347 .go_parent_cb = ms_vty_go_parent,
351 int l23_app_init(int (*mncc_recv)(struct osmocom_ms *ms, int, void *),
352 const char *config_file, uint16_t vty_port)
354 struct telnet_connection dummy_conn;
357 mncc_recv_app = mncc_recv;
363 dummy_conn.priv = NULL;
365 if (config_file != NULL) {
366 rc = vty_read_config_file(config_file, &dummy_conn);
368 fprintf(stderr, "Failed to parse the config file:"
369 " '%s'\n", config_file);
370 fprintf(stderr, "Please check or create config file"
371 " using: 'touch %s'\n", config_file);
376 telnet_init(l23_ctx, NULL, vty_port);
379 printf("VTY available on port %u.\n", vty_port);
381 osmo_signal_register_handler(SS_GLOBAL, &global_signal_cb, NULL);
382 osmo_signal_register_handler(SS_L1CTL, &mobile_signal_cb, NULL);
383 osmo_signal_register_handler(SS_L1CTL, &gsm322_l1_signal, NULL);
385 if (llist_empty(&ms_list)) {
386 struct osmocom_ms *ms;
388 printf("No Mobile Station defined, creating: MS '1'\n");
389 ms = mobile_new("1");