stktest: Add STK Agent API skeleton
[platform/upstream/ofono.git] / tools / stktest.c
1 /*
2  *
3  *  oFono - Open Source Telephony
4  *
5  *  Copyright (C) 2008-2011  Intel Corporation. All rights reserved.
6  *
7  *  This program is free software; you can redistribute it and/or modify
8  *  it under the terms of the GNU General Public License version 2 as
9  *  published by the Free Software Foundation.
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
17  *  along with this program; if not, write to the Free Software
18  *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
19  *
20  */
21
22 #ifdef HAVE_CONFIG_H
23 #include <config.h>
24 #endif
25
26 #include <stdio.h>
27 #include <errno.h>
28 #include <fcntl.h>
29 #include <unistd.h>
30 #include <stdlib.h>
31 #include <string.h>
32 #include <signal.h>
33 #include <netinet/in.h>
34 #include <arpa/inet.h>
35
36 #include <gdbus.h>
37 #include <gatchat/gatserver.h>
38
39 #define OFONO_SERVICE   "org.ofono"
40 #define STKTEST_PATH    "/stktest"
41 #define STKTEST_ERROR   "org.ofono.stktest"
42 #define OFONO_MANAGER_INTERFACE         OFONO_SERVICE ".Manager"
43 #define OFONO_MODEM_INTERFACE           OFONO_SERVICE ".Modem"
44 #define OFONO_STK_INTERFACE             OFONO_SERVICE ".SimToolkit"
45 #define OFONO_STKAGENT_INTERFACE        OFONO_SERVICE ".SimToolkitAgent"
46
47 #define LISTEN_PORT     12765
48
49 enum test_state {
50         TEST_STATE_POWERING_UP = 1,
51         TEST_STATE_REGISTERING_AGENT,
52         TEST_STATE_RUNNING,
53         TEST_STATE_POWERING_DOWN,
54 };
55
56 static GMainLoop *main_loop = NULL;
57 static volatile sig_atomic_t __terminated = 0;
58
59 /* DBus related */
60 static DBusConnection *conn;
61 static gboolean ofono_running = FALSE;
62 static guint modem_changed_watch;
63 enum test_state state;
64
65 /* Emulator setup */
66 static guint server_watch;
67 static GAtServer *emulator;
68
69 /* Emulated modem state variables */
70 static int modem_mode = 0;
71
72 static gboolean create_tcp(void);
73
74 static DBusMessage *stktest_error_invalid_args(DBusMessage *msg)
75 {
76         return g_dbus_create_error(msg, STKTEST_ERROR ".InvalidArguments",
77                                         "Invalid arguments provided");
78 }
79
80 static DBusMessage *agent_release(DBusConnection *conn, DBusMessage *msg,
81                                         void *data)
82 {
83         g_print("Got Release");
84
85         return dbus_message_new_method_return(msg);
86 }
87
88 static DBusMessage *agent_display_text(DBusConnection *conn, DBusMessage *msg,
89                                         void *data)
90 {
91         const char *text;
92         unsigned char icon_id;
93         dbus_bool_t urgent;
94
95         if (dbus_message_get_args(msg, NULL, DBUS_TYPE_STRING, &text,
96                                                 DBUS_TYPE_BYTE, &icon_id,
97                                                 DBUS_TYPE_BOOLEAN, &urgent,
98                                                 DBUS_TYPE_INVALID) == FALSE)
99                 return stktest_error_invalid_args(msg);
100
101         g_print("Got DisplayText with: %s, %u, %d\n", text, icon_id, urgent);
102
103         return dbus_message_new_method_return(msg);
104 }
105
106 static void server_debug(const char *str, void *data)
107 {
108         g_print("%s: %s\n", (char *) data, str);
109 }
110
111 static void cgmi_cb(GAtServer *server, GAtServerRequestType type,
112                         GAtResult *cmd, gpointer user)
113 {
114         switch (type) {
115         case G_AT_SERVER_REQUEST_TYPE_COMMAND_ONLY:
116                 g_at_server_send_info(server, "oFono", TRUE);
117                 g_at_server_send_final(server, G_AT_SERVER_RESULT_OK);
118                 break;
119         case G_AT_SERVER_REQUEST_TYPE_SUPPORT:
120                 g_at_server_send_final(server, G_AT_SERVER_RESULT_OK);
121                 break;
122         default:
123                 g_at_server_send_final(server, G_AT_SERVER_RESULT_ERROR);
124         };
125 }
126
127 static void cgmm_cb(GAtServer *server, GAtServerRequestType type,
128                         GAtResult *cmd, gpointer user)
129 {
130         switch (type) {
131         case G_AT_SERVER_REQUEST_TYPE_COMMAND_ONLY:
132                 g_at_server_send_info(server, "oFono pre-1.0", TRUE);
133                 g_at_server_send_final(server, G_AT_SERVER_RESULT_OK);
134                 break;
135         case G_AT_SERVER_REQUEST_TYPE_SUPPORT:
136                 g_at_server_send_final(server, G_AT_SERVER_RESULT_OK);
137                 break;
138         default:
139                 g_at_server_send_final(server, G_AT_SERVER_RESULT_ERROR);
140         };
141 }
142
143 static void cgmr_cb(GAtServer *server, GAtServerRequestType type,
144                         GAtResult *cmd, gpointer user)
145 {
146         char buf[256];
147
148         switch (type) {
149         case G_AT_SERVER_REQUEST_TYPE_COMMAND_ONLY:
150                 sprintf(buf, "oFono pre-1.0 version: %s", VERSION);
151                 g_at_server_send_info(server, buf, TRUE);
152                 g_at_server_send_final(server, G_AT_SERVER_RESULT_OK);
153                 break;
154         case G_AT_SERVER_REQUEST_TYPE_SUPPORT:
155                 g_at_server_send_final(server, G_AT_SERVER_RESULT_OK);
156                 break;
157         default:
158                 g_at_server_send_final(server, G_AT_SERVER_RESULT_ERROR);
159         };
160 }
161
162 static void cgsn_cb(GAtServer *server, GAtServerRequestType type,
163                         GAtResult *cmd, gpointer user)
164 {
165         switch (type) {
166         case G_AT_SERVER_REQUEST_TYPE_COMMAND_ONLY:
167                 g_at_server_send_info(server, "123456789", TRUE);
168                 g_at_server_send_final(server, G_AT_SERVER_RESULT_OK);
169                 break;
170         case G_AT_SERVER_REQUEST_TYPE_SUPPORT:
171                 g_at_server_send_final(server, G_AT_SERVER_RESULT_OK);
172                 break;
173         default:
174                 g_at_server_send_final(server, G_AT_SERVER_RESULT_ERROR);
175         };
176 }
177
178 static gboolean send_ok(gpointer user)
179 {
180         GAtServer *server = user;
181
182         g_at_server_send_final(server, G_AT_SERVER_RESULT_OK);
183
184         return FALSE;
185 }
186
187 static void cfun_cb(GAtServer *server, GAtServerRequestType type,
188                         GAtResult *cmd, gpointer user)
189 {
190         char buf[12];
191
192         switch (type) {
193         case G_AT_SERVER_REQUEST_TYPE_SUPPORT:
194                 g_at_server_send_info(server, "+CFUN: (0-1,4)", TRUE);
195                 g_at_server_send_final(server, G_AT_SERVER_RESULT_OK);
196                 break;
197         case G_AT_SERVER_REQUEST_TYPE_QUERY:
198                 snprintf(buf, sizeof(buf), "+CFUN: %d", modem_mode);
199                 g_at_server_send_info(server, buf, TRUE);
200                 g_at_server_send_final(server, G_AT_SERVER_RESULT_OK);
201                 break;
202         case G_AT_SERVER_REQUEST_TYPE_SET:
203         {
204                 GAtResultIter iter;
205                 int mode;
206
207                 g_at_result_iter_init(&iter, cmd);
208                 g_at_result_iter_next(&iter, "");
209
210                 if (g_at_result_iter_next_number(&iter, &mode) == FALSE)
211                         goto error;
212
213                 if (mode != 0 && mode != 1)
214                         goto error;
215
216                 if (modem_mode == mode) {
217                         g_at_server_send_final(server, G_AT_SERVER_RESULT_OK);
218                         break;
219                 }
220
221                 modem_mode = mode;
222                 g_timeout_add_seconds(1, send_ok, server);
223                 break;
224         }
225         default:
226                 goto error;
227         };
228
229         return;
230
231 error:
232         g_at_server_send_final(server, G_AT_SERVER_RESULT_ERROR);
233 }
234
235 static void listen_again(gpointer user_data)
236 {
237         if (create_tcp() == TRUE)
238                 return;
239
240         g_print("Error listening to socket\n");
241         g_main_loop_quit(main_loop);
242 }
243
244 static void setup_emulator(GAtServer *server)
245 {
246         g_at_server_set_debug(server, server_debug, "Server");
247
248         g_at_server_register(server, "+CGMI",    cgmi_cb,    NULL, NULL);
249         g_at_server_register(server, "+CGMM",    cgmm_cb,    NULL, NULL);
250         g_at_server_register(server, "+CGMR",    cgmr_cb,    NULL, NULL);
251         g_at_server_register(server, "+CGSN",    cgsn_cb,    NULL, NULL);
252         g_at_server_register(server, "+CFUN",    cfun_cb,    NULL, NULL);
253
254         g_at_server_set_disconnect_function(server, listen_again, NULL);
255 }
256
257 static gboolean on_socket_connected(GIOChannel *chan, GIOCondition cond,
258                                                         gpointer user)
259 {
260         struct sockaddr saddr;
261         unsigned int len = sizeof(saddr);
262         int fd;
263         GIOChannel *client_io = NULL;
264
265         if (cond != G_IO_IN)
266                 goto error;
267
268         fd = accept(g_io_channel_unix_get_fd(chan), &saddr, &len);
269         if (fd == -1)
270                 goto error;
271
272         client_io = g_io_channel_unix_new(fd);
273
274         emulator = g_at_server_new(client_io);
275         g_io_channel_unref(client_io);
276
277         if (emulator == NULL)
278                 goto error;
279
280         setup_emulator(emulator);
281
282 error:
283         server_watch = 0;
284         return FALSE;
285 }
286
287 static gboolean create_tcp(void)
288 {
289         struct sockaddr_in addr;
290         int sk;
291         int reuseaddr = 1;
292         GIOChannel *server_io;
293
294         sk = socket(PF_INET, SOCK_STREAM, 0);
295         if (sk < 0) {
296                 g_print("Can't create tcp/ip socket: %s (%d)\n",
297                                                 strerror(errno), errno);
298                 return FALSE;
299         }
300
301         memset(&addr, 0, sizeof(addr));
302
303         addr.sin_family = AF_INET;
304         addr.sin_addr.s_addr = INADDR_ANY;
305         addr.sin_port = htons(LISTEN_PORT);
306
307         setsockopt(sk, SOL_SOCKET, SO_REUSEADDR, &reuseaddr, sizeof(reuseaddr));
308         if (bind(sk, (struct sockaddr *) &addr, sizeof(struct sockaddr)) < 0) {
309                 g_print("Can't bind socket: %s (%d)", strerror(errno), errno);
310                 close(sk);
311                 return FALSE;
312         }
313
314         if (listen(sk, 1) < 0) {
315                 g_print("Can't listen on socket: %s (%d)",
316                                                 strerror(errno), errno);
317                 close(sk);
318                 return FALSE;
319         }
320
321         g_print("new tcp is created at tcp port %d\n", LISTEN_PORT);
322
323         server_io = g_io_channel_unix_new(sk);
324         g_io_channel_set_close_on_unref(server_io, TRUE);
325
326         server_watch = g_io_add_watch_full(server_io,
327                                 G_PRIORITY_DEFAULT,
328                                 G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
329                                 on_socket_connected, NULL, NULL);
330
331         g_io_channel_unref(server_io);
332
333         return TRUE;
334 }
335
336 static gboolean has_stk_interface(DBusMessageIter *iter)
337 {
338         DBusMessageIter entry;
339
340         dbus_message_iter_recurse(iter, &entry);
341
342         while (dbus_message_iter_get_arg_type(&entry) == DBUS_TYPE_STRING) {
343                 const char *interface;
344
345                 dbus_message_iter_get_basic(&entry, &interface);
346
347                 if (g_str_equal(interface, OFONO_STK_INTERFACE) == TRUE)
348                         return TRUE;
349
350                 dbus_message_iter_next(&entry);
351         }
352
353         return FALSE;
354 }
355
356 static void set_property_reply(DBusPendingCall *call, void *user_data)
357 {
358         DBusMessage *reply = dbus_pending_call_steal_reply(call);
359         DBusError err;
360
361         dbus_error_init(&err);
362
363         if (dbus_set_error_from_message(&err, reply) == TRUE) {
364                 g_printerr("%s: %s\n", err.name, err.message);
365                 dbus_error_free(&err);
366         }
367
368         dbus_message_unref(reply);
369 }
370
371 static int set_property(const char *path, const char *interface,
372                         const char *key, int type, const void *val,
373                         DBusPendingCallNotifyFunction notify,
374                         gpointer user_data,
375                         DBusFreeFunction destroy)
376 {
377         DBusMessage *msg;
378         DBusMessageIter iter, value;
379         DBusPendingCall *call;
380         const char *signature;
381
382         msg = dbus_message_new_method_call(OFONO_SERVICE, path, interface,
383                                                 "SetProperty");
384         if (msg == NULL)
385                 return -ENOMEM;
386
387         dbus_message_set_auto_start(msg, FALSE);
388
389         dbus_message_iter_init_append(msg, &iter);
390
391         dbus_message_iter_append_basic(&iter, DBUS_TYPE_STRING, &key);
392
393         switch (type) {
394         case DBUS_TYPE_BOOLEAN:
395                 signature = DBUS_TYPE_BOOLEAN_AS_STRING;
396                 break;
397         default:
398                 dbus_message_unref(msg);
399                 return -EINVAL;
400         }
401
402         dbus_message_iter_open_container(&iter, DBUS_TYPE_VARIANT,
403                                                         signature, &value);
404         dbus_message_iter_append_basic(&value, type, val);
405         dbus_message_iter_close_container(&iter, &value);
406
407         if (dbus_connection_send_with_reply(conn, msg, &call, -1) == FALSE) {
408                 dbus_message_unref(msg);
409                 return -EIO;
410         }
411
412         dbus_message_unref(msg);
413
414         if (call == NULL)
415                 return -EINVAL;
416
417         dbus_pending_call_set_notify(call, notify, user_data, destroy);
418
419         dbus_pending_call_unref(call);
420
421         return 0;
422 }
423
424 static void register_agent()
425 {
426         state = TEST_STATE_REGISTERING_AGENT;
427         g_print("Gained STK interface, registering agent...\n");
428 }
429
430 static gboolean modem_changed(DBusConnection *conn,
431                                 DBusMessage *msg, void *user_data)
432 {
433         DBusMessageIter iter, value;
434         const char *path, *key;
435         gboolean has_stk;
436
437         if (dbus_message_iter_init(msg, &iter) == FALSE)
438                 return TRUE;
439
440         path = dbus_message_get_path(msg);
441
442         if (g_str_equal(STKTEST_PATH, path) == FALSE)
443                 return TRUE;
444
445         dbus_message_iter_get_basic(&iter, &key);
446
447         dbus_message_iter_next(&iter);
448         dbus_message_iter_recurse(&iter, &value);
449
450         if (g_str_equal(key, "Interfaces") == FALSE)
451                 return TRUE;
452
453         has_stk = has_stk_interface(&value);
454
455         switch (state) {
456         case TEST_STATE_POWERING_UP:
457                 if (has_stk)
458                         register_agent();
459                 break;
460         case TEST_STATE_REGISTERING_AGENT:
461         case TEST_STATE_RUNNING:
462                 if (has_stk == FALSE)
463                         g_printerr("Unexpectedly lost STK interface\n");
464                 /* Fall through */
465         case TEST_STATE_POWERING_DOWN:
466                 break;
467         };
468
469         return TRUE;
470 }
471
472 static void powerup(void)
473 {
474         dbus_bool_t powered = TRUE;
475
476         state = TEST_STATE_POWERING_UP;
477         set_property(STKTEST_PATH, OFONO_MODEM_INTERFACE, "Powered",
478                         DBUS_TYPE_BOOLEAN, &powered,
479                         set_property_reply, NULL, NULL);
480 }
481
482 static void get_modems_reply(DBusPendingCall *call, void *user_data)
483 {
484         DBusMessage *reply = dbus_pending_call_steal_reply(call);
485         DBusMessageIter iter, list;
486         DBusError err;
487         gboolean found = FALSE;
488
489         dbus_error_init(&err);
490
491         if (dbus_set_error_from_message(&err, reply) == TRUE) {
492                 g_printerr("%s: %s\n", err.name, err.message);
493                 dbus_error_free(&err);
494                 goto done;
495         }
496
497         if (dbus_message_has_signature(reply, "a(oa{sv})") == FALSE)
498                 goto done;
499
500         if (dbus_message_iter_init(reply, &iter) == FALSE)
501                 goto done;
502
503         dbus_message_iter_recurse(&iter, &list);
504
505         while (dbus_message_iter_get_arg_type(&list) == DBUS_TYPE_STRUCT) {
506                 DBusMessageIter entry;
507                 const char *path;
508
509                 dbus_message_iter_recurse(&list, &entry);
510                 dbus_message_iter_get_basic(&entry, &path);
511
512                 if (g_str_equal(path, STKTEST_PATH))
513                         found = TRUE;
514
515                 dbus_message_iter_next(&list);
516         }
517
518 done:
519         dbus_message_unref(reply);
520
521         if (found == FALSE) {
522                 g_printerr("STK Test modem not found\n");
523                 g_main_loop_quit(main_loop);
524                 return;
525         }
526
527         g_print("Test modem found\n");
528
529         modem_changed_watch = g_dbus_add_signal_watch(conn, OFONO_SERVICE,
530                                                         STKTEST_PATH,
531                                                         OFONO_MODEM_INTERFACE,
532                                                         "PropertyChanged",
533                                                         modem_changed,
534                                                         NULL, NULL);
535
536         if (create_tcp() == FALSE) {
537                 g_printerr("Unable to listen on modem emulator socket\n");
538                 g_main_loop_quit(main_loop);
539         }
540
541         powerup();
542 }
543
544 static int get_modems(DBusConnection *conn)
545 {
546         DBusMessage *msg;
547         DBusPendingCall *call;
548
549         msg = dbus_message_new_method_call(OFONO_SERVICE, "/",
550                                         OFONO_MANAGER_INTERFACE, "GetModems");
551         if (msg == NULL)
552                 return -ENOMEM;
553
554         dbus_message_set_auto_start(msg, FALSE);
555
556         g_print("getting modems\n");
557
558         if (dbus_connection_send_with_reply(conn, msg, &call, -1) == FALSE) {
559                 dbus_message_unref(msg);
560                 return -EIO;
561         }
562
563         dbus_message_unref(msg);
564
565         if (call == NULL)
566                 return -EINVAL;
567
568         dbus_pending_call_set_notify(call, get_modems_reply, conn, NULL);
569
570         dbus_pending_call_unref(call);
571
572         return 0;
573 }
574
575 static const GDBusMethodTable agent_methods[] = {
576         { GDBUS_METHOD("Release", NULL, NULL, agent_release) },
577         { GDBUS_METHOD("DisplayText",
578                 GDBUS_ARGS({ "text", "s" }, { "icon_id", "y" },
579                                 { "urgent", "b" }), NULL,
580                                 agent_display_text) },
581         { },
582 };
583
584 static void ofono_connect(DBusConnection *conn, void *user_data)
585 {
586         g_print("starting telephony interface\n");
587
588         if (!g_dbus_register_interface(conn, "/default",
589                                         OFONO_STKAGENT_INTERFACE,
590                                         agent_methods, NULL, NULL,
591                                         NULL, NULL)) {
592                 g_printerr("Unable to register local agent");
593                 g_main_loop_quit(main_loop);
594         }
595
596         ofono_running = TRUE;
597         get_modems(conn);
598 }
599
600 static void ofono_disconnect(DBusConnection *conn, void *user_data)
601 {
602         g_print("stopping telephony interface\n");
603
604         g_dbus_unregister_interface(conn, "/default", OFONO_STKAGENT_INTERFACE);
605
606         ofono_running = FALSE;
607
608         g_dbus_remove_watch(conn, modem_changed_watch);
609         modem_changed_watch = 0;
610
611         if (server_watch) {
612                 g_source_remove(server_watch);
613                 server_watch = 0;
614         }
615
616         g_at_server_unref(emulator);
617         emulator = NULL;
618 }
619
620 static void sig_term(int sig)
621 {
622         if (__terminated > 0)
623                 return;
624
625         __terminated = 1;
626
627         g_print("Terminating\n");
628
629         g_main_loop_quit(main_loop);
630 }
631
632 static void disconnect_callback(DBusConnection *conn, void *user_data)
633 {
634         g_printerr("D-Bus disconnect\n");
635
636         g_main_loop_quit(main_loop);
637 }
638
639 static gboolean option_version = FALSE;
640
641 static GOptionEntry options[] = {
642         { "version", 'v', 0, G_OPTION_ARG_NONE, &option_version,
643                                 "Show version information and exit" },
644         { NULL },
645 };
646
647 int main(int argc, char **argv)
648 {
649         GOptionContext *context;
650         GError *error = NULL;
651         DBusError err;
652         guint watch;
653         struct sigaction sa;
654
655         context = g_option_context_new(NULL);
656         g_option_context_add_main_entries(context, options, NULL);
657
658         if (g_option_context_parse(context, &argc, &argv, &error) == FALSE) {
659                 if (error != NULL) {
660                         g_printerr("%s\n", error->message);
661                         g_error_free(error);
662                 } else
663                         g_printerr("An unknown error occurred\n");
664                 exit(1);
665         }
666
667         g_option_context_free(context);
668
669         if (option_version == TRUE) {
670                 printf("%s\n", VERSION);
671                 exit(0);
672         }
673
674         main_loop = g_main_loop_new(NULL, FALSE);
675
676         dbus_error_init(&err);
677
678         conn = g_dbus_setup_bus(DBUS_BUS_SYSTEM, NULL, &err);
679         if (conn == NULL) {
680                 if (dbus_error_is_set(&err) == TRUE) {
681                         fprintf(stderr, "%s\n", err.message);
682                         dbus_error_free(&err);
683                 } else
684                         fprintf(stderr, "Can't register with system bus\n");
685                 exit(1);
686         }
687
688         g_dbus_set_disconnect_function(conn, disconnect_callback, NULL, NULL);
689
690         memset(&sa, 0, sizeof(sa));
691         sa.sa_handler = sig_term;
692         sigaction(SIGINT, &sa, NULL);
693         sigaction(SIGTERM, &sa, NULL);
694
695         watch = g_dbus_add_service_watch(conn, OFONO_SERVICE,
696                                 ofono_connect, ofono_disconnect, NULL, NULL);
697
698         g_main_loop_run(main_loop);
699
700         g_dbus_remove_watch(conn, watch);
701
702         if (ofono_running == TRUE)
703                 ofono_disconnect(conn, NULL);
704
705         dbus_connection_unref(conn);
706
707         g_main_loop_unref(main_loop);
708
709         return 0;
710 }