Fix Valgrind Invalid Read error while removing gsupplicant interface
[framework/connectivity/connman.git] / gsupplicant / supplicant.c
1 /*
2  *
3  *  WPA supplicant library with GLib integration
4  *
5  *  Copyright (C) 2010  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 <errno.h>
27 #include <stdio.h>
28 #include <stdlib.h>
29 #include <string.h>
30 #include <stdint.h>
31 #include <syslog.h>
32
33 #include <glib.h>
34 #include <gdbus.h>
35
36 #include "dbus.h"
37 #include "gsupplicant.h"
38
39 #define TIMEOUT 5000
40
41 #define IEEE80211_CAP_ESS       0x0001
42 #define IEEE80211_CAP_IBSS      0x0002
43 #define IEEE80211_CAP_PRIVACY   0x0010
44
45 static DBusConnection *connection;
46
47 static const GSupplicantCallbacks *callbacks_pointer;
48
49 static dbus_bool_t system_available = FALSE;
50 static dbus_bool_t system_ready = FALSE;
51
52 static dbus_int32_t debug_level;
53 static dbus_bool_t debug_timestamp = FALSE;
54 static dbus_bool_t debug_showkeys = FALSE;
55
56 static const char *debug_strings[] = {
57         "msgdump", "debug", "info", "warning", "error", NULL
58 };
59
60 static unsigned int eap_methods;
61
62 struct strvalmap {
63         const char *str;
64         unsigned int val;
65 };
66
67 static struct strvalmap eap_method_map[] = {
68         { "MD5",        G_SUPPLICANT_EAP_METHOD_MD5     },
69         { "TLS",        G_SUPPLICANT_EAP_METHOD_TLS     },
70         { "MSCHAPV2",   G_SUPPLICANT_EAP_METHOD_MSCHAPV2        },
71         { "PEAP",       G_SUPPLICANT_EAP_METHOD_PEAP    },
72         { "TTLS",       G_SUPPLICANT_EAP_METHOD_TTLS    },
73         { "GTC",        G_SUPPLICANT_EAP_METHOD_GTC     },
74         { "OTP",        G_SUPPLICANT_EAP_METHOD_OTP     },
75         { "LEAP",       G_SUPPLICANT_EAP_METHOD_LEAP    },
76         { "WSC",        G_SUPPLICANT_EAP_METHOD_WSC     },
77         { }
78 };
79
80 static struct strvalmap keymgmt_map[] = {
81         { "none",               G_SUPPLICANT_KEYMGMT_NONE               },
82         { "ieee8021x",          G_SUPPLICANT_KEYMGMT_IEEE8021X  },
83         { "wpa-none",           G_SUPPLICANT_KEYMGMT_WPA_NONE   },
84         { "wpa-psk",            G_SUPPLICANT_KEYMGMT_WPA_PSK    },
85         { "wpa-psk-sha256",     G_SUPPLICANT_KEYMGMT_WPA_PSK_256        },
86         { "wpa-ft-psk",         G_SUPPLICANT_KEYMGMT_WPA_FT_PSK },
87         { "wpa-ft-eap",         G_SUPPLICANT_KEYMGMT_WPA_FT_EAP },
88         { "wpa-eap",            G_SUPPLICANT_KEYMGMT_WPA_EAP    },
89         { "wpa-eap-sha256",     G_SUPPLICANT_KEYMGMT_WPA_EAP_256        },
90         { "wps",                G_SUPPLICANT_KEYMGMT_WPS                },
91         { }
92 };
93
94 static struct strvalmap authalg_capa_map[] = {
95         { "open",       G_SUPPLICANT_CAPABILITY_AUTHALG_OPEN    },
96         { "shared",     G_SUPPLICANT_CAPABILITY_AUTHALG_SHARED  },
97         { "leap",       G_SUPPLICANT_CAPABILITY_AUTHALG_LEAP    },
98         { }
99 };
100
101 static struct strvalmap proto_capa_map[] = {
102         { "wpa",        G_SUPPLICANT_CAPABILITY_PROTO_WPA               },
103         { "rsn",        G_SUPPLICANT_CAPABILITY_PROTO_RSN               },
104         { }
105 };
106
107 static struct strvalmap group_map[] = {
108         { "wep40",      G_SUPPLICANT_GROUP_WEP40        },
109         { "wep104",     G_SUPPLICANT_GROUP_WEP104       },
110         { "tkip",       G_SUPPLICANT_GROUP_TKIP },
111         { "ccmp",       G_SUPPLICANT_GROUP_CCMP },
112         { }
113 };
114
115 static struct strvalmap pairwise_map[] = {
116         { "none",       G_SUPPLICANT_PAIRWISE_NONE      },
117         { "tkip",       G_SUPPLICANT_PAIRWISE_TKIP      },
118         { "ccmp",       G_SUPPLICANT_PAIRWISE_CCMP      },
119         { }
120 };
121
122 static struct strvalmap scan_capa_map[] = {
123         { "active",     G_SUPPLICANT_CAPABILITY_SCAN_ACTIVE     },
124         { "passive",    G_SUPPLICANT_CAPABILITY_SCAN_PASSIVE    },
125         { "ssid",       G_SUPPLICANT_CAPABILITY_SCAN_SSID               },
126         { }
127 };
128
129 static struct strvalmap mode_capa_map[] = {
130         { "infrastructure",     G_SUPPLICANT_CAPABILITY_MODE_INFRA      },
131         { "ad-hoc",             G_SUPPLICANT_CAPABILITY_MODE_IBSS       },
132         { "ap",                 G_SUPPLICANT_CAPABILITY_MODE_AP         },
133         { }
134 };
135
136 static GHashTable *interface_table;
137 static GHashTable *bss_mapping;
138
139 struct _GSupplicantInterface {
140         char *path;
141         char *network_path;
142         unsigned int keymgmt_capa;
143         unsigned int authalg_capa;
144         unsigned int proto_capa;
145         unsigned int group_capa;
146         unsigned int pairwise_capa;
147         unsigned int scan_capa;
148         unsigned int mode_capa;
149         dbus_bool_t ready;
150         GSupplicantState state;
151         dbus_bool_t scanning;
152         GSupplicantInterfaceCallback scan_callback;
153         void *scan_data;
154         int apscan;
155         char *ifname;
156         char *driver;
157         char *bridge;
158         GHashTable *network_table;
159         GHashTable *net_mapping;
160         GHashTable *bss_mapping;
161         void *data;
162 };
163
164 struct _GSupplicantNetwork {
165         GSupplicantInterface *interface;
166         char *path;
167         char *group;
168         char *name;
169         unsigned char ssid[32];
170         unsigned int ssid_len;
171         dbus_int16_t signal;
172         GSupplicantMode mode;
173         GSupplicantSecurity security;
174         GHashTable *bss_table;
175         GHashTable *config_table;
176 };
177
178 struct g_supplicant_bss {
179         GSupplicantInterface *interface;
180         char *path;
181         unsigned char bssid[6];
182         unsigned char ssid[32];
183         unsigned int ssid_len;
184         dbus_uint16_t frequency;
185         dbus_uint32_t maxrate;
186         dbus_int16_t signal;
187         GSupplicantMode mode;
188         GSupplicantSecurity security;
189         unsigned int keymgmt;
190         unsigned int pairwise;
191         unsigned int group;
192         dbus_bool_t privacy;
193         dbus_bool_t psk;
194         dbus_bool_t ieee8021x;
195 };
196
197 static inline void debug(const char *format, ...)
198 {
199         char str[256];
200         va_list ap;
201
202         if (callbacks_pointer->debug == NULL)
203                 return;
204
205         va_start(ap, format);
206
207         if (vsnprintf(str, sizeof(str), format, ap) > 0)
208                 callbacks_pointer->debug(str);
209
210         va_end(ap);
211 }
212
213 #define SUPPLICANT_DBG(fmt, arg...) \
214         debug("%s:%s() " fmt, __FILE__, __FUNCTION__ , ## arg);
215
216 static GSupplicantMode string2mode(const char *mode)
217 {
218         if (mode == NULL)
219                 return G_SUPPLICANT_MODE_UNKNOWN;
220
221         if (g_str_equal(mode, "infrastructure") == TRUE)
222                 return G_SUPPLICANT_MODE_INFRA;
223         else if (g_str_equal(mode, "ad-hoc") == TRUE)
224                 return G_SUPPLICANT_MODE_IBSS;
225
226         return G_SUPPLICANT_MODE_UNKNOWN;
227 }
228
229 static const char *mode2string(GSupplicantMode mode)
230 {
231         switch (mode) {
232         case G_SUPPLICANT_MODE_UNKNOWN:
233                 break;
234         case G_SUPPLICANT_MODE_INFRA:
235                 return "managed";
236         case G_SUPPLICANT_MODE_IBSS:
237                 return "adhoc";
238         }
239
240         return NULL;
241 }
242
243 static const char *security2string(GSupplicantSecurity security)
244 {
245         switch (security) {
246         case G_SUPPLICANT_SECURITY_UNKNOWN:
247                 break;
248         case G_SUPPLICANT_SECURITY_NONE:
249                 return "none";
250         case G_SUPPLICANT_SECURITY_WEP:
251                 return "wep";
252         case G_SUPPLICANT_SECURITY_PSK:
253                 return "psk";
254         case G_SUPPLICANT_SECURITY_IEEE8021X:
255                 return "ieee8021x";
256         }
257
258         return NULL;
259 }
260
261 static GSupplicantState string2state(const char *state)
262 {
263         if (state == NULL)
264                 return G_SUPPLICANT_STATE_UNKNOWN;
265
266         if (g_str_equal(state, "unknown") == TRUE)
267                 return G_SUPPLICANT_STATE_UNKNOWN;
268         else if (g_str_equal(state, "disconnected") == TRUE)
269                 return G_SUPPLICANT_STATE_DISCONNECTED;
270         else if (g_str_equal(state, "inactive") == TRUE)
271                 return G_SUPPLICANT_STATE_INACTIVE;
272         else if (g_str_equal(state, "scanning") == TRUE)
273                 return G_SUPPLICANT_STATE_SCANNING;
274         else if (g_str_equal(state, "authenticating") == TRUE)
275                 return G_SUPPLICANT_STATE_AUTHENTICATING;
276         else if (g_str_equal(state, "associating") == TRUE)
277                 return G_SUPPLICANT_STATE_ASSOCIATING;
278         else if (g_str_equal(state, "associated") == TRUE)
279                 return G_SUPPLICANT_STATE_ASSOCIATED;
280         else if (g_str_equal(state, "group_handshake") == TRUE)
281                 return G_SUPPLICANT_STATE_GROUP_HANDSHAKE;
282         else if (g_str_equal(state, "4way_handshake") == TRUE)
283                 return G_SUPPLICANT_STATE_4WAY_HANDSHAKE;
284         else if (g_str_equal(state, "completed") == TRUE)
285                 return G_SUPPLICANT_STATE_COMPLETED;
286
287         return G_SUPPLICANT_STATE_UNKNOWN;
288 }
289
290 static void callback_system_ready(void)
291 {
292         if (system_ready == TRUE)
293                 return;
294
295         system_ready = TRUE;
296
297         if (callbacks_pointer == NULL)
298                 return;
299
300         if (callbacks_pointer->system_ready == NULL)
301                 return;
302
303         callbacks_pointer->system_ready();
304 }
305
306 static void callback_system_killed(void)
307 {
308         system_ready = FALSE;
309
310         if (callbacks_pointer == NULL)
311                 return;
312
313         if (callbacks_pointer->system_killed == NULL)
314                 return;
315
316         callbacks_pointer->system_killed();
317 }
318
319 static void callback_interface_added(GSupplicantInterface *interface)
320 {
321         SUPPLICANT_DBG("");
322
323         if (callbacks_pointer == NULL)
324                 return;
325
326         if (callbacks_pointer->interface_added == NULL)
327                 return;
328
329         callbacks_pointer->interface_added(interface);
330 }
331
332 static void callback_interface_state(GSupplicantInterface *interface)
333 {
334         if (callbacks_pointer == NULL)
335                 return;
336
337         if (callbacks_pointer->interface_state == NULL)
338                 return;
339
340         callbacks_pointer->interface_state(interface);
341 }
342
343 static void callback_interface_removed(GSupplicantInterface *interface)
344 {
345         if (callbacks_pointer == NULL)
346                 return;
347
348         if (callbacks_pointer->interface_removed == NULL)
349                 return;
350
351         callbacks_pointer->interface_removed(interface);
352 }
353
354 static void callback_scan_started(GSupplicantInterface *interface)
355 {
356         if (callbacks_pointer == NULL)
357                 return;
358
359         if (callbacks_pointer->scan_started == NULL)
360                 return;
361
362         callbacks_pointer->scan_started(interface);
363 }
364
365 static void callback_scan_finished(GSupplicantInterface *interface)
366 {
367         if (callbacks_pointer == NULL)
368                 return;
369
370         if (callbacks_pointer->scan_finished == NULL)
371                 return;
372
373         callbacks_pointer->scan_finished(interface);
374 }
375
376 static void callback_network_added(GSupplicantNetwork *network)
377 {
378         if (callbacks_pointer == NULL)
379                 return;
380
381         if (callbacks_pointer->network_added == NULL)
382                 return;
383
384         callbacks_pointer->network_added(network);
385 }
386
387 static void callback_network_removed(GSupplicantNetwork *network)
388 {
389         if (callbacks_pointer == NULL)
390                 return;
391
392         if (callbacks_pointer->network_removed == NULL)
393                 return;
394
395         callbacks_pointer->network_removed(network);
396 }
397
398 static void remove_interface(gpointer data)
399 {
400         GSupplicantInterface *interface = data;
401
402         g_hash_table_destroy(interface->bss_mapping);
403         g_hash_table_destroy(interface->net_mapping);
404         g_hash_table_destroy(interface->network_table);
405
406         callback_interface_removed(interface);
407
408         g_free(interface->path);
409         g_free(interface->network_path);
410         g_free(interface->ifname);
411         g_free(interface->driver);
412         g_free(interface->bridge);
413         g_free(interface);
414 }
415
416 static void remove_network(gpointer data)
417 {
418         GSupplicantNetwork *network = data;
419
420         g_hash_table_destroy(network->bss_table);
421
422         callback_network_removed(network);
423
424         g_hash_table_destroy(network->config_table);
425
426         g_free(network->path);
427         g_free(network->group);
428         g_free(network->name);
429         g_free(network);
430 }
431
432 static void remove_bss(gpointer data)
433 {
434         struct g_supplicant_bss *bss = data;
435
436         g_free(bss->path);
437         g_free(bss);
438 }
439
440 static void debug_strvalmap(const char *label, struct strvalmap *map,
441                                                         unsigned int val)
442 {
443         int i;
444
445         for (i = 0; map[i].str != NULL; i++) {
446                 if (val & map[i].val)
447                         SUPPLICANT_DBG("%s: %s", label, map[i].str);
448         }
449 }
450
451 static void interface_capability_keymgmt(DBusMessageIter *iter, void *user_data)
452 {
453         GSupplicantInterface *interface = user_data;
454         const char *str = NULL;
455         int i;
456
457         dbus_message_iter_get_basic(iter, &str);
458         if (str == NULL)
459                 return;
460
461         for (i = 0; keymgmt_map[i].str != NULL; i++)
462                 if (strcmp(str, keymgmt_map[i].str) == 0) {
463                         interface->keymgmt_capa |= keymgmt_map[i].val;
464                         break;
465                 }
466 }
467
468 static void interface_capability_authalg(DBusMessageIter *iter, void *user_data)
469 {
470         GSupplicantInterface *interface = user_data;
471         const char *str = NULL;
472         int i;
473
474         dbus_message_iter_get_basic(iter, &str);
475         if (str == NULL)
476                 return;
477
478         for (i = 0; authalg_capa_map[i].str != NULL; i++)
479                 if (strcmp(str, authalg_capa_map[i].str) == 0) {
480                         interface->authalg_capa |= authalg_capa_map[i].val;
481                         break;
482                 }
483 }
484
485 static void interface_capability_proto(DBusMessageIter *iter, void *user_data)
486 {
487         GSupplicantInterface *interface = user_data;
488         const char *str = NULL;
489         int i;
490
491         dbus_message_iter_get_basic(iter, &str);
492         if (str == NULL)
493                 return;
494
495         for (i = 0; proto_capa_map[i].str != NULL; i++)
496                 if (strcmp(str, proto_capa_map[i].str) == 0) {
497                         interface->proto_capa |= proto_capa_map[i].val;
498                         break;
499                 }
500 }
501
502 static void interface_capability_pairwise(DBusMessageIter *iter,
503                                                         void *user_data)
504 {
505         GSupplicantInterface *interface = user_data;
506         const char *str = NULL;
507         int i;
508
509         dbus_message_iter_get_basic(iter, &str);
510         if (str == NULL)
511                 return;
512
513         for (i = 0; pairwise_map[i].str != NULL; i++)
514                 if (strcmp(str, pairwise_map[i].str) == 0) {
515                         interface->pairwise_capa |= pairwise_map[i].val;
516                         break;
517                 }
518 }
519
520 static void interface_capability_group(DBusMessageIter *iter, void *user_data)
521 {
522         GSupplicantInterface *interface = user_data;
523         const char *str = NULL;
524         int i;
525
526         dbus_message_iter_get_basic(iter, &str);
527         if (str == NULL)
528                 return;
529
530         for (i = 0; group_map[i].str != NULL; i++)
531                 if (strcmp(str, group_map[i].str) == 0) {
532                         interface->group_capa |= group_map[i].val;
533                         break;
534                 }
535 }
536
537 static void interface_capability_scan(DBusMessageIter *iter, void *user_data)
538 {
539         GSupplicantInterface *interface = user_data;
540         const char *str = NULL;
541         int i;
542
543         dbus_message_iter_get_basic(iter, &str);
544         if (str == NULL)
545                 return;
546
547         for (i = 0; scan_capa_map[i].str != NULL; i++)
548                 if (strcmp(str, scan_capa_map[i].str) == 0) {
549                         interface->scan_capa |= scan_capa_map[i].val;
550                         break;
551                 }
552 }
553
554 static void interface_capability_mode(DBusMessageIter *iter, void *user_data)
555 {
556         GSupplicantInterface *interface = user_data;
557         const char *str = NULL;
558         int i;
559
560         dbus_message_iter_get_basic(iter, &str);
561         if (str == NULL)
562                 return;
563
564         for (i = 0; mode_capa_map[i].str != NULL; i++)
565                 if (strcmp(str, mode_capa_map[i].str) == 0) {
566                         interface->mode_capa |= mode_capa_map[i].val;
567                         break;
568                 }
569 }
570
571 static void interface_capability(const char *key, DBusMessageIter *iter,
572                                                         void *user_data)
573 {
574         GSupplicantInterface *interface = user_data;
575
576         if (key == NULL)
577                 return;
578
579         if (g_strcmp0(key, "KeyMgmt") == 0)
580                 supplicant_dbus_array_foreach(iter,
581                                 interface_capability_keymgmt, interface);
582         else if (g_strcmp0(key, "AuthAlg") == 0)
583                 supplicant_dbus_array_foreach(iter,
584                                 interface_capability_authalg, interface);
585         else if (g_strcmp0(key, "Protocol") == 0)
586                 supplicant_dbus_array_foreach(iter,
587                                 interface_capability_proto, interface);
588         else if (g_strcmp0(key, "Pairwise") == 0)
589                 supplicant_dbus_array_foreach(iter,
590                                 interface_capability_pairwise, interface);
591         else if (g_strcmp0(key, "Group") == 0)
592                 supplicant_dbus_array_foreach(iter,
593                                 interface_capability_group, interface);
594         else if (g_strcmp0(key, "Scan") == 0)
595                 supplicant_dbus_array_foreach(iter,
596                                 interface_capability_scan, interface);
597         else if (g_strcmp0(key, "Modes") == 0)
598                 supplicant_dbus_array_foreach(iter,
599                                 interface_capability_mode, interface);
600         else
601                 SUPPLICANT_DBG("key %s type %c",
602                                 key, dbus_message_iter_get_arg_type(iter));
603 }
604
605 void g_supplicant_interface_set_data(GSupplicantInterface *interface,
606                                                                 void *data)
607 {
608         if (interface == NULL)
609                 return;
610
611         interface->data = data;
612 }
613
614 void *g_supplicant_interface_get_data(GSupplicantInterface *interface)
615 {
616         if (interface == NULL)
617                 return NULL;
618
619         return interface->data;
620 }
621
622 const char *g_supplicant_interface_get_ifname(GSupplicantInterface *interface)
623 {
624         if (interface == NULL)
625                 return NULL;
626
627         return interface->ifname;
628 }
629
630 const char *g_supplicant_interface_get_driver(GSupplicantInterface *interface)
631 {
632         if (interface == NULL)
633                 return NULL;
634
635         return interface->driver;
636 }
637
638 GSupplicantState g_supplicant_interface_get_state(
639                                         GSupplicantInterface *interface)
640 {
641         if (interface == NULL)
642                 return G_SUPPLICANT_STATE_UNKNOWN;
643
644         return interface->state;
645 }
646
647 GSupplicantInterface *g_supplicant_network_get_interface(
648                                         GSupplicantNetwork *network)
649 {
650         if (network == NULL)
651                 return NULL;
652
653         return network->interface;
654 }
655
656 const char *g_supplicant_network_get_name(GSupplicantNetwork *network)
657 {
658         if (network == NULL || network->name == NULL)
659                 return "";
660
661         return network->name;
662 }
663
664 const char *g_supplicant_network_get_identifier(GSupplicantNetwork *network)
665 {
666         if (network == NULL || network->group == NULL)
667                 return "";
668
669         return network->group;
670 }
671
672 const char *g_supplicant_network_get_path(GSupplicantNetwork *network)
673 {
674         if (network == NULL || network->path == NULL)
675                 return NULL;
676
677         return network->path;
678 }
679
680 const char *g_supplicant_network_get_mode(GSupplicantNetwork *network)
681 {
682         if (network == NULL)
683                 return G_SUPPLICANT_MODE_UNKNOWN;
684
685         return mode2string(network->mode);
686 }
687
688 const char *g_supplicant_network_get_security(GSupplicantNetwork *network)
689 {
690         if (network == NULL)
691                 return G_SUPPLICANT_SECURITY_UNKNOWN;
692
693         return security2string(network->security);
694 }
695
696 const void *g_supplicant_network_get_ssid(GSupplicantNetwork *network,
697                                                 unsigned int *ssid_len)
698 {
699         if (network == NULL || network->ssid == NULL) {
700                 *ssid_len = 0;
701                 return NULL;
702         }
703
704         *ssid_len = network->ssid_len;
705         return network->ssid;
706 }
707
708 dbus_int16_t g_supplicant_network_get_signal(GSupplicantNetwork *network)
709 {
710         if (network == NULL)
711                 return 0;
712
713         return network->signal;
714 }
715
716 static void merge_network(GSupplicantNetwork *network)
717 {
718         GString *str;
719         const char *ssid, *mode, *key_mgmt;
720         unsigned int i, ssid_len;
721         char *group;
722
723         ssid = g_hash_table_lookup(network->config_table, "ssid");
724         mode = g_hash_table_lookup(network->config_table, "mode");
725         key_mgmt = g_hash_table_lookup(network->config_table, "key_mgmt");
726
727         SUPPLICANT_DBG("ssid %s mode %s", ssid, mode);
728
729         if (ssid != NULL)
730                 ssid_len = strlen(ssid);
731         else
732                 ssid_len = 0;
733
734         str = g_string_sized_new((ssid_len * 2) + 24);
735         if (str == NULL)
736                 return;
737
738         for (i = 0; i < ssid_len; i++)
739                 g_string_append_printf(str, "%02x", ssid[i]);
740
741         if (g_strcmp0(mode, "0") == 0)
742                 g_string_append_printf(str, "_managed");
743         else if (g_strcmp0(mode, "1") == 0)
744                 g_string_append_printf(str, "_adhoc");
745
746         if (g_strcmp0(key_mgmt, "WPA-PSK") == 0)
747                 g_string_append_printf(str, "_psk");
748
749         group = g_string_free(str, FALSE);
750
751         SUPPLICANT_DBG("%s", group);
752
753         g_free(group);
754
755         g_hash_table_destroy(network->config_table);
756
757         g_free(network->path);
758         g_free(network);
759 }
760
761 static void network_property(const char *key, DBusMessageIter *iter,
762                                                         void *user_data)
763 {
764         GSupplicantNetwork *network = user_data;
765
766         if (network->interface == NULL)
767                 return;
768
769         if (key == NULL) {
770                 merge_network(network);
771                 return;
772         }
773
774         if (g_strcmp0(key, "Enabled") == 0) {
775                 dbus_bool_t enabled = FALSE;
776
777                 dbus_message_iter_get_basic(iter, &enabled);
778         } else if (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_STRING) {
779                 const char *str = NULL;
780
781                 dbus_message_iter_get_basic(iter, &str);
782                 if (str != NULL) {
783                         g_hash_table_replace(network->config_table,
784                                                 g_strdup(key), g_strdup(str));
785                 }
786         } else
787                 SUPPLICANT_DBG("key %s type %c",
788                                 key, dbus_message_iter_get_arg_type(iter));
789 }
790
791 static void interface_network_added(DBusMessageIter *iter, void *user_data)
792 {
793         GSupplicantInterface *interface = user_data;
794         GSupplicantNetwork *network;
795         const char *path = NULL;
796
797         SUPPLICANT_DBG("");
798
799         dbus_message_iter_get_basic(iter, &path);
800         if (path == NULL)
801                 return;
802
803         if (g_strcmp0(path, "/") == 0)
804                 return;
805
806         network = g_hash_table_lookup(interface->net_mapping, path);
807         if (network != NULL)
808                 return;
809
810         network = g_try_new0(GSupplicantNetwork, 1);
811         if (network == NULL)
812                 return;
813
814         network->interface = interface;
815         network->path = g_strdup(path);
816
817         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
818                                                         g_free, g_free);
819
820         dbus_message_iter_next(iter);
821         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
822                 supplicant_dbus_property_foreach(iter, network_property,
823                                                                 network);
824                 network_property(NULL, NULL, network);
825                 return;
826         }
827
828         supplicant_dbus_property_get_all(path,
829                                 SUPPLICANT_INTERFACE ".Network",
830                                                 network_property, network);
831 }
832
833 static void interface_network_removed(DBusMessageIter *iter, void *user_data)
834 {
835         GSupplicantInterface *interface = user_data;
836         GSupplicantNetwork *network;
837         const char *path = NULL;
838
839         dbus_message_iter_get_basic(iter, &path);
840         if (path == NULL)
841                 return;
842
843         network = g_hash_table_lookup(interface->net_mapping, path);
844         if (network == NULL)
845                 return;
846
847         g_hash_table_remove(interface->net_mapping, path);
848 }
849
850 static char *create_name(unsigned char *ssid, int ssid_len)
851 {
852         char *name;
853         int i;
854
855         if (ssid_len < 1 || ssid[0] == '\0')
856                 name = NULL;
857         else
858                 name = g_try_malloc0(ssid_len + 1);
859
860         if (name == NULL)
861                 return g_strdup("");
862
863         for (i = 0; i < ssid_len; i++) {
864                 if (g_ascii_isprint(ssid[i]))
865                         name[i] = ssid[i];
866                 else
867                         name[i] = ' ';
868         }
869
870         return name;
871 }
872
873 static char *create_group(struct g_supplicant_bss *bss)
874 {
875         GString *str;
876         unsigned int i;
877         const char *mode, *security;
878
879         str = g_string_sized_new((bss->ssid_len * 2) + 24);
880         if (str == NULL)
881                 return NULL;
882
883         if (bss->ssid_len > 0 && bss->ssid[0] != '\0') {
884                 for (i = 0; i < bss->ssid_len; i++)
885                         g_string_append_printf(str, "%02x", bss->ssid[i]);
886         } else
887                 g_string_append_printf(str, "hidden");
888
889         mode = mode2string(bss->mode);
890         if (mode != NULL)
891                 g_string_append_printf(str, "_%s", mode);
892
893         security = security2string(bss->security);
894         if (security != NULL)
895                 g_string_append_printf(str, "_%s", security);
896
897         return g_string_free(str, FALSE);
898 }
899
900 static void add_bss_to_network(struct g_supplicant_bss *bss)
901 {
902         GSupplicantInterface *interface = bss->interface;
903         GSupplicantNetwork *network;
904         char *group;
905
906         group = create_group(bss);
907         if (group == NULL)
908                 return;
909
910         network = g_hash_table_lookup(interface->network_table, group);
911         if (network != NULL) {
912                 g_free(group);
913                 goto done;
914         }
915
916         network = g_try_new0(GSupplicantNetwork, 1);
917         if (network == NULL) {
918                 g_free(group);
919                 return;
920         }
921
922         network->interface = interface;
923         if (network->path == NULL)
924                 network->path = g_strdup(bss->path);
925         network->group = group;
926         network->name = create_name(bss->ssid, bss->ssid_len);
927         network->mode = bss->mode;
928         network->security = bss->security;
929         network->ssid_len = bss->ssid_len;
930         memcpy(network->ssid, bss->ssid, bss->ssid_len);
931         network->signal = bss->signal;
932
933         network->bss_table = g_hash_table_new_full(g_str_hash, g_str_equal,
934                                                         NULL, remove_bss);
935
936         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
937                                                         g_free, g_free);
938
939         g_hash_table_replace(interface->network_table,
940                                                 network->group, network);
941
942         callback_network_added(network);
943
944 done:
945         g_hash_table_replace(interface->bss_mapping, bss->path, network);
946         g_hash_table_replace(network->bss_table, bss->path, bss);
947
948         g_hash_table_replace(bss_mapping, bss->path, interface);
949 }
950
951 static void bss_rates(DBusMessageIter *iter, void *user_data)
952 {
953         struct g_supplicant_bss *bss = user_data;
954         dbus_uint32_t rate = 0;
955
956         dbus_message_iter_get_basic(iter, &rate);
957         if (rate == 0)
958                 return;
959
960         if (rate > bss->maxrate)
961                 bss->maxrate = rate;
962 }
963
964 static void bss_keymgmt(DBusMessageIter *iter, void *user_data)
965 {
966         struct g_supplicant_bss *bss = user_data;
967         const char *str = NULL;
968         int i;
969
970         dbus_message_iter_get_basic(iter, &str);
971         if (str == NULL)
972                 return;
973
974         for (i = 0; keymgmt_map[i].str != NULL; i++)
975                 if (strcmp(str, keymgmt_map[i].str) == 0) {
976                         bss->keymgmt |= keymgmt_map[i].val;
977                         break;
978                 }
979 }
980
981 static void bss_group(DBusMessageIter *iter, void *user_data)
982 {
983         struct g_supplicant_bss *bss = user_data;
984         const char *str = NULL;
985         int i;
986
987         dbus_message_iter_get_basic(iter, &str);
988         if (str == NULL)
989                 return;
990
991         for (i = 0; group_map[i].str != NULL; i++)
992                 if (strcmp(str, group_map[i].str) == 0) {
993                         bss->group |= group_map[i].val;
994                         break;
995                 }
996 }
997
998 static void bss_pairwise(DBusMessageIter *iter, void *user_data)
999 {
1000         struct g_supplicant_bss *bss = user_data;
1001         const char *str = NULL;
1002         int i;
1003
1004         dbus_message_iter_get_basic(iter, &str);
1005         if (str == NULL)
1006                 return;
1007
1008         for (i = 0; pairwise_map[i].str != NULL; i++)
1009                 if (strcmp(str, pairwise_map[i].str) == 0) {
1010                         bss->pairwise |= pairwise_map[i].val;
1011                         break;
1012                 }
1013 }
1014
1015 static void bss_wpa(const char *key, DBusMessageIter *iter,
1016                         void *user_data)
1017 {
1018         if (g_strcmp0(key, "KeyMgmt") == 0)
1019                 supplicant_dbus_array_foreach(iter, bss_keymgmt, user_data);
1020         else if (g_strcmp0(key, "Group") == 0)
1021                 supplicant_dbus_array_foreach(iter, bss_group, user_data);
1022         else if (g_strcmp0(key, "Pairwise") == 0)
1023                 supplicant_dbus_array_foreach(iter, bss_pairwise, user_data);
1024
1025 }
1026
1027
1028 static void bss_property(const char *key, DBusMessageIter *iter,
1029                                                         void *user_data)
1030 {
1031         struct g_supplicant_bss *bss = user_data;
1032
1033         if (bss->interface == NULL)
1034                 return;
1035
1036         SUPPLICANT_DBG("key %s", key);
1037
1038         if (key == NULL) {
1039                 if (bss->ieee8021x == TRUE)
1040                         bss->security = G_SUPPLICANT_SECURITY_IEEE8021X;
1041                 else if (bss->psk == TRUE)
1042                         bss->security = G_SUPPLICANT_SECURITY_PSK;
1043                 else if (bss->privacy == TRUE)
1044                         bss->security = G_SUPPLICANT_SECURITY_WEP;
1045                 else
1046                         bss->security = G_SUPPLICANT_SECURITY_NONE;
1047
1048                 add_bss_to_network(bss);
1049                 return;
1050         }
1051
1052         if (g_strcmp0(key, "BSSID") == 0) {
1053                 DBusMessageIter array;
1054                 unsigned char *addr;
1055                 int addr_len;
1056
1057                 dbus_message_iter_recurse(iter, &array);
1058                 dbus_message_iter_get_fixed_array(&array, &addr, &addr_len);
1059
1060                 if (addr_len == 6)
1061                         memcpy(bss->bssid, addr, addr_len);
1062         } else if (g_strcmp0(key, "SSID") == 0) {
1063                 DBusMessageIter array;
1064                 unsigned char *ssid;
1065                 int ssid_len;
1066
1067                 dbus_message_iter_recurse(iter, &array);
1068                 dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
1069
1070                 if (ssid_len > 0 && ssid_len < 33) {
1071                         memcpy(bss->ssid, ssid, ssid_len);
1072                         bss->ssid_len = ssid_len;
1073                 } else {
1074                         memset(bss->ssid, 0, sizeof(bss->ssid));
1075                         bss->ssid_len = 0;
1076                 }
1077         } else if (g_strcmp0(key, "Capabilities") == 0) {
1078                 dbus_uint16_t capabilities = 0x0000;
1079
1080                 dbus_message_iter_get_basic(iter, &capabilities);
1081
1082                 if (capabilities & IEEE80211_CAP_ESS)
1083                         bss->mode = G_SUPPLICANT_MODE_INFRA;
1084                 else if (capabilities & IEEE80211_CAP_IBSS)
1085                         bss->mode = G_SUPPLICANT_MODE_IBSS;
1086
1087                 if (capabilities & IEEE80211_CAP_PRIVACY)
1088                         bss->privacy = TRUE;
1089         } else if (g_strcmp0(key, "Mode") == 0) {
1090                 const char *mode = NULL;
1091
1092                 dbus_message_iter_get_basic(iter, &mode);
1093                 bss->mode = string2mode(mode);
1094         } else if (g_strcmp0(key, "Frequency") == 0) {
1095                 dbus_uint16_t frequency = 0;
1096
1097                 dbus_message_iter_get_basic(iter, &frequency);
1098                 bss->frequency = frequency;
1099         } else if (g_strcmp0(key, "Signal") == 0) {
1100                 dbus_int16_t signal = 0;
1101
1102                 dbus_message_iter_get_basic(iter, &signal);
1103
1104                 bss->signal = signal;
1105         } else if (g_strcmp0(key, "Level") == 0) {
1106                 dbus_int32_t level = 0;
1107
1108                 dbus_message_iter_get_basic(iter, &level);
1109         } else if (g_strcmp0(key, "Rates") == 0) {
1110                 supplicant_dbus_array_foreach(iter, bss_rates, bss);
1111         } else if (g_strcmp0(key, "MaxRate") == 0) {
1112                 dbus_uint32_t maxrate = 0;
1113
1114                 dbus_message_iter_get_basic(iter, &maxrate);
1115                 if (maxrate != 0)
1116                         bss->maxrate = maxrate;
1117         } else if (g_strcmp0(key, "Privacy") == 0) {
1118                 dbus_bool_t privacy = FALSE;
1119
1120                 dbus_message_iter_get_basic(iter, &privacy);
1121                 bss->privacy = privacy;
1122         } else if ((g_strcmp0(key, "RSN") == 0) ||
1123                         (g_strcmp0(key, "WPA") == 0)) {
1124                 supplicant_dbus_property_foreach(iter, bss_wpa, bss);
1125
1126                 if (bss->keymgmt &
1127                         (G_SUPPLICANT_KEYMGMT_WPA_EAP |
1128                                 G_SUPPLICANT_KEYMGMT_WPA_FT_EAP |
1129                                 G_SUPPLICANT_KEYMGMT_WPA_EAP_256))
1130                         bss->ieee8021x = TRUE;
1131
1132                 if (bss->keymgmt &
1133                         (G_SUPPLICANT_KEYMGMT_WPA_PSK |
1134                                 G_SUPPLICANT_KEYMGMT_WPA_FT_PSK |
1135                                 G_SUPPLICANT_KEYMGMT_WPA_PSK_256))
1136                         bss->psk = TRUE;
1137         } else
1138                 SUPPLICANT_DBG("key %s type %c",
1139                                 key, dbus_message_iter_get_arg_type(iter));
1140 }
1141
1142 static void interface_bss_added(DBusMessageIter *iter, void *user_data)
1143 {
1144         GSupplicantInterface *interface = user_data;
1145         GSupplicantNetwork *network;
1146         struct g_supplicant_bss *bss;
1147         const char *path = NULL;
1148
1149         SUPPLICANT_DBG("");
1150
1151         dbus_message_iter_get_basic(iter, &path);
1152         if (path == NULL)
1153                 return;
1154
1155         if (g_strcmp0(path, "/") == 0)
1156                 return;
1157
1158         SUPPLICANT_DBG("%s", path);
1159
1160         network = g_hash_table_lookup(interface->bss_mapping, path);
1161         if (network != NULL) {
1162                 bss = g_hash_table_lookup(network->bss_table, path);
1163                 if (bss != NULL)
1164                         return;
1165         }
1166
1167         bss = g_try_new0(struct g_supplicant_bss, 1);
1168         if (bss == NULL)
1169                 return;
1170
1171         bss->interface = interface;
1172         bss->path = g_strdup(path);
1173
1174         dbus_message_iter_next(iter);
1175         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
1176                 supplicant_dbus_property_foreach(iter, bss_property, bss);
1177                 bss_property(NULL, NULL, bss);
1178                 return;
1179         }
1180
1181         supplicant_dbus_property_get_all(path,
1182                                         SUPPLICANT_INTERFACE ".BSS",
1183                                                         bss_property, bss);
1184 }
1185
1186 static void interface_bss_removed(DBusMessageIter *iter, void *user_data)
1187 {
1188         GSupplicantInterface *interface = user_data;
1189         GSupplicantNetwork *network;
1190         const char *path = NULL;
1191
1192         dbus_message_iter_get_basic(iter, &path);
1193         if (path == NULL)
1194                 return;
1195
1196         network = g_hash_table_lookup(interface->bss_mapping, path);
1197         if (network == NULL)
1198                 return;
1199
1200         g_hash_table_remove(bss_mapping, path);
1201
1202         g_hash_table_remove(interface->bss_mapping, path);
1203         g_hash_table_remove(network->bss_table, path);
1204
1205         if (g_hash_table_size(network->bss_table) == 0)
1206                 g_hash_table_remove(interface->network_table, network->group);
1207 }
1208
1209 static void interface_property(const char *key, DBusMessageIter *iter,
1210                                                         void *user_data)
1211 {
1212         GSupplicantInterface *interface = user_data;
1213
1214         if (interface == NULL)
1215                 return;
1216
1217         SUPPLICANT_DBG("%s", key);
1218
1219         if (key == NULL) {
1220                 debug_strvalmap("KeyMgmt capability", keymgmt_map,
1221                                                 interface->keymgmt_capa);
1222                 debug_strvalmap("AuthAlg capability", authalg_capa_map,
1223                                                 interface->authalg_capa);
1224                 debug_strvalmap("Protocol capability", proto_capa_map,
1225                                                 interface->proto_capa);
1226                 debug_strvalmap("Pairwise capability", pairwise_map,
1227                                                 interface->pairwise_capa);
1228                 debug_strvalmap("Group capability", group_map,
1229                                                 interface->group_capa);
1230                 debug_strvalmap("Scan capability", scan_capa_map,
1231                                                 interface->scan_capa);
1232                 debug_strvalmap("Mode capability", mode_capa_map,
1233                                                 interface->mode_capa);
1234
1235                 interface->ready = TRUE;
1236                 callback_interface_added(interface);
1237                 return;
1238         }
1239
1240         if (g_strcmp0(key, "Capabilities") == 0) {
1241                 supplicant_dbus_property_foreach(iter, interface_capability,
1242                                                                 interface);
1243         } else if (g_strcmp0(key, "State") == 0) {
1244                 const char *str = NULL;
1245
1246                 dbus_message_iter_get_basic(iter, &str);
1247                 if (str != NULL)
1248                         if (string2state(str) != interface->state) {
1249                                 interface->state = string2state(str);
1250                                 callback_interface_state(interface);
1251                         }
1252
1253                 SUPPLICANT_DBG("state %s (%d)", str, interface->state);
1254         } else if (g_strcmp0(key, "Scanning") == 0) {
1255                 dbus_bool_t scanning = FALSE;
1256
1257                 dbus_message_iter_get_basic(iter, &scanning);
1258                 interface->scanning = scanning;
1259
1260                 if (interface->ready == TRUE) {
1261                         if (interface->scanning == TRUE)
1262                                 callback_scan_started(interface);
1263                         else
1264                                 callback_scan_finished(interface);
1265                 }
1266         } else if (g_strcmp0(key, "ApScan") == 0) {
1267                 int apscan = 1;
1268
1269                 dbus_message_iter_get_basic(iter, &apscan);
1270                 interface->apscan = apscan;
1271         } else if (g_strcmp0(key, "Ifname") == 0) {
1272                 const char *str = NULL;
1273
1274                 dbus_message_iter_get_basic(iter, &str);
1275                 if (str != NULL)
1276                         interface->ifname = g_strdup(str);
1277         } else if (g_strcmp0(key, "Driver") == 0) {
1278                 const char *str = NULL;
1279
1280                 dbus_message_iter_get_basic(iter, &str);
1281                 if (str != NULL)
1282                         interface->driver = g_strdup(str);
1283         } else if (g_strcmp0(key, "BridgeIfname") == 0) {
1284                 const char *str = NULL;
1285
1286                 dbus_message_iter_get_basic(iter, &str);
1287                 if (str != NULL)
1288                         interface->bridge = g_strdup(str);
1289         } else if (g_strcmp0(key, "CurrentBSS") == 0) {
1290                 interface_bss_added(iter, interface);
1291         } else if (g_strcmp0(key, "CurrentNetwork") == 0) {
1292                 interface_network_added(iter, interface);
1293         } else if (g_strcmp0(key, "BSSs") == 0) {
1294                 supplicant_dbus_array_foreach(iter, interface_bss_added,
1295                                                                 interface);
1296         } else if (g_strcmp0(key, "Blobs") == 0) {
1297                 /* Nothing */
1298         } else if (g_strcmp0(key, "Networks") == 0) {
1299                 supplicant_dbus_array_foreach(iter, interface_network_added,
1300                                                                 interface);
1301         } else
1302                 SUPPLICANT_DBG("key %s type %c",
1303                                 key, dbus_message_iter_get_arg_type(iter));
1304 }
1305
1306 static void scan_network_update(DBusMessageIter *iter, void *user_data)
1307 {
1308         GSupplicantInterface *interface = user_data;
1309         GSupplicantNetwork *network;
1310         char *path;
1311
1312         if (iter == NULL)
1313                 return;
1314
1315         dbus_message_iter_get_basic(iter, &path);
1316
1317         if (path == NULL)
1318                 return;
1319
1320         if (g_strcmp0(path, "/") == 0)
1321                 return;
1322
1323         /* Update the network details based on scan BSS data */
1324         network = g_hash_table_lookup(interface->bss_mapping, path);
1325         if (network != NULL)
1326                 callback_network_added(network);
1327 }
1328
1329 static void scan_bss_data(const char *key, DBusMessageIter *iter,
1330                                 void *user_data)
1331 {
1332         GSupplicantInterface *interface = user_data;
1333
1334         if (iter)
1335                 supplicant_dbus_array_foreach(iter, scan_network_update,
1336                                                 interface);
1337
1338         if (interface->scan_callback != NULL)
1339                 interface->scan_callback(0, interface, interface->scan_data);
1340
1341         interface->scan_callback = NULL;
1342         interface->scan_data = NULL;
1343 }
1344
1345 static GSupplicantInterface *interface_alloc(const char *path)
1346 {
1347         GSupplicantInterface *interface;
1348
1349         interface = g_try_new0(GSupplicantInterface, 1);
1350         if (interface == NULL)
1351                 return NULL;
1352
1353         interface->path = g_strdup(path);
1354
1355         interface->network_table = g_hash_table_new_full(g_str_hash,
1356                                         g_str_equal, NULL, remove_network);
1357
1358         interface->net_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1359                                                                 NULL, NULL);
1360         interface->bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1361                                                                 NULL, NULL);
1362
1363         g_hash_table_replace(interface_table, interface->path, interface);
1364
1365         return interface;
1366 }
1367
1368 static void interface_added(DBusMessageIter *iter, void *user_data)
1369 {
1370         GSupplicantInterface *interface;
1371         const char *path = NULL;
1372
1373         SUPPLICANT_DBG("");
1374
1375         dbus_message_iter_get_basic(iter, &path);
1376         if (path == NULL)
1377                 return;
1378
1379         if (g_strcmp0(path, "/") == 0)
1380                 return;
1381
1382         interface = g_hash_table_lookup(interface_table, path);
1383         if (interface != NULL)
1384                 return;
1385
1386         interface = interface_alloc(path);
1387         if (interface == NULL)
1388                 return;
1389
1390         dbus_message_iter_next(iter);
1391         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
1392                 supplicant_dbus_property_foreach(iter, interface_property,
1393                                                                 interface);
1394                 interface_property(NULL, NULL, interface);
1395                 return;
1396         }
1397
1398         supplicant_dbus_property_get_all(path,
1399                                         SUPPLICANT_INTERFACE ".Interface",
1400                                                 interface_property, interface);
1401 }
1402
1403 static void interface_removed(DBusMessageIter *iter, void *user_data)
1404 {
1405         const char *path = NULL;
1406
1407         dbus_message_iter_get_basic(iter, &path);
1408         if (path == NULL)
1409                 return;
1410
1411         g_hash_table_remove(interface_table, path);
1412 }
1413
1414 static void eap_method(DBusMessageIter *iter, void *user_data)
1415 {
1416         const char *str = NULL;
1417         int i;
1418
1419         dbus_message_iter_get_basic(iter, &str);
1420         if (str == NULL)
1421                 return;
1422
1423         for (i = 0; eap_method_map[i].str != NULL; i++)
1424                 if (strcmp(str, eap_method_map[i].str) == 0) {
1425                         eap_methods |= eap_method_map[i].val;
1426                         break;
1427                 }
1428 }
1429
1430 static void service_property(const char *key, DBusMessageIter *iter,
1431                                                         void *user_data)
1432 {
1433         if (key == NULL) {
1434                 callback_system_ready();
1435                 return;
1436         }
1437
1438         if (g_strcmp0(key, "DebugLevel") == 0) {
1439                 const char *str = NULL;
1440                 int i;
1441
1442                 dbus_message_iter_get_basic(iter, &str);
1443                 for (i = 0; debug_strings[i] != NULL; i++)
1444                         if (g_strcmp0(debug_strings[i], str) == 0) {
1445                                 debug_level = i;
1446                                 break;
1447                         }
1448                 SUPPLICANT_DBG("Debug level %d", debug_level);
1449         } else if (g_strcmp0(key, "DebugTimestamp") == 0) {
1450                 dbus_message_iter_get_basic(iter, &debug_timestamp);
1451                 SUPPLICANT_DBG("Debug timestamp %u", debug_timestamp);
1452         } else if (g_strcmp0(key, "DebugShowKeys") == 0) {
1453                 dbus_message_iter_get_basic(iter, &debug_showkeys);
1454                 SUPPLICANT_DBG("Debug show keys %u", debug_showkeys);
1455         } else if (g_strcmp0(key, "Interfaces") == 0) {
1456                 supplicant_dbus_array_foreach(iter, interface_added, NULL);
1457         } else if (g_strcmp0(key, "EapMethods") == 0) {
1458                 supplicant_dbus_array_foreach(iter, eap_method, NULL);
1459                 debug_strvalmap("EAP method", eap_method_map, eap_methods);
1460         } else if (g_strcmp0(key, "Country") == 0) {
1461                 const char *country = NULL;
1462
1463                 dbus_message_iter_get_basic(iter, &country);
1464                 SUPPLICANT_DBG("Country %s", country);
1465         } else
1466                 SUPPLICANT_DBG("key %s type %c",
1467                                 key, dbus_message_iter_get_arg_type(iter));
1468 }
1469
1470 static void signal_name_owner_changed(const char *path, DBusMessageIter *iter)
1471 {
1472         const char *name = NULL, *old = NULL, *new = NULL;
1473
1474         SUPPLICANT_DBG("");
1475
1476         if (g_strcmp0(path, DBUS_PATH_DBUS) != 0)
1477                 return;
1478
1479         dbus_message_iter_get_basic(iter, &name);
1480         if (name == NULL)
1481                 return;
1482
1483         if (g_strcmp0(name, SUPPLICANT_SERVICE) != 0)
1484                 return;
1485
1486         dbus_message_iter_next(iter);
1487         dbus_message_iter_get_basic(iter, &old);
1488         dbus_message_iter_next(iter);
1489         dbus_message_iter_get_basic(iter, &new);
1490
1491         if (old == NULL || new == NULL)
1492                 return;
1493
1494         if (strlen(old) > 0 && strlen(new) == 0) {
1495                 system_available = FALSE;
1496                 g_hash_table_remove_all(bss_mapping);
1497                 g_hash_table_remove_all(interface_table);
1498                 callback_system_killed();
1499         }
1500
1501         if (strlen(new) > 0 && strlen(old) == 0) {
1502                 system_available = TRUE;
1503                 supplicant_dbus_property_get_all(SUPPLICANT_PATH,
1504                                                         SUPPLICANT_INTERFACE,
1505                                                         service_property, NULL);
1506         }
1507 }
1508
1509 static void signal_properties_changed(const char *path, DBusMessageIter *iter)
1510 {
1511         SUPPLICANT_DBG("");
1512
1513         if (g_strcmp0(path, SUPPLICANT_PATH) != 0)
1514                 return;
1515
1516         supplicant_dbus_property_foreach(iter, service_property, NULL);
1517 }
1518
1519 static void signal_interface_added(const char *path, DBusMessageIter *iter)
1520 {
1521         SUPPLICANT_DBG("path %s %s", path, SUPPLICANT_PATH);
1522
1523         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
1524                 interface_added(iter, NULL);
1525 }
1526
1527 static void signal_interface_removed(const char *path, DBusMessageIter *iter)
1528 {
1529         SUPPLICANT_DBG("");
1530
1531         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
1532                 interface_removed(iter, NULL);
1533 }
1534
1535 static void signal_interface_changed(const char *path, DBusMessageIter *iter)
1536 {
1537         GSupplicantInterface *interface;
1538
1539         SUPPLICANT_DBG("");
1540
1541         interface = g_hash_table_lookup(interface_table, path);
1542         if (interface == NULL)
1543                 return;
1544
1545         supplicant_dbus_property_foreach(iter, interface_property, interface);
1546 }
1547
1548 static void signal_scan_done(const char *path, DBusMessageIter *iter)
1549 {
1550         GSupplicantInterface *interface;
1551         dbus_bool_t success = FALSE;
1552
1553         SUPPLICANT_DBG("");
1554
1555         interface = g_hash_table_lookup(interface_table, path);
1556         if (interface == NULL)
1557                 return;
1558
1559         dbus_message_iter_get_basic(iter, &success);
1560
1561         /*
1562          * If scan is unsuccessful return -EIO else get the scanned BSSs
1563          * and update the network details accordingly
1564          */
1565         if (success == FALSE) {
1566                 if (interface->scan_callback != NULL)
1567                         interface->scan_callback(-EIO, interface,
1568                                                 interface->scan_data);
1569
1570                 interface->scan_callback = NULL;
1571                 interface->scan_data = NULL;
1572
1573                 return;
1574         }
1575
1576         supplicant_dbus_property_get(path, SUPPLICANT_INTERFACE ".Interface",
1577                                         "BSSs", scan_bss_data, interface);
1578 }
1579
1580 static void signal_bss_added(const char *path, DBusMessageIter *iter)
1581 {
1582         GSupplicantInterface *interface;
1583
1584         SUPPLICANT_DBG("");
1585
1586         interface = g_hash_table_lookup(interface_table, path);
1587         if (interface == NULL)
1588                 return;
1589
1590         interface_bss_added(iter, interface);
1591 }
1592
1593 static void signal_bss_removed(const char *path, DBusMessageIter *iter)
1594 {
1595         GSupplicantInterface *interface;
1596
1597         SUPPLICANT_DBG("");
1598
1599         interface = g_hash_table_lookup(interface_table, path);
1600         if (interface == NULL)
1601                 return;
1602
1603         interface_bss_removed(iter, interface);
1604 }
1605
1606 static void signal_network_added(const char *path, DBusMessageIter *iter)
1607 {
1608         GSupplicantInterface *interface;
1609
1610         SUPPLICANT_DBG("");
1611
1612         interface = g_hash_table_lookup(interface_table, path);
1613         if (interface == NULL)
1614                 return;
1615
1616         interface_network_added(iter, interface);
1617 }
1618
1619 static void signal_network_removed(const char *path, DBusMessageIter *iter)
1620 {
1621         GSupplicantInterface *interface;
1622
1623         SUPPLICANT_DBG("");
1624
1625         interface = g_hash_table_lookup(interface_table, path);
1626         if (interface == NULL)
1627                 return;
1628
1629         interface_network_removed(iter, interface);
1630 }
1631
1632 static void signal_bss_changed(const char *path, DBusMessageIter *iter)
1633 {
1634         GSupplicantInterface *interface;
1635         GSupplicantNetwork *network;
1636         struct g_supplicant_bss *bss;
1637
1638         SUPPLICANT_DBG("");
1639
1640         interface = g_hash_table_lookup(bss_mapping, path);
1641         if (interface == NULL)
1642                 return;
1643
1644         network = g_hash_table_lookup(interface->bss_mapping, path);
1645         if (network == NULL)
1646                 return;
1647
1648         bss = g_hash_table_lookup(network->bss_table, path);
1649         if (bss == NULL)
1650                 return;
1651
1652         supplicant_dbus_property_foreach(iter, bss_property, bss);
1653 }
1654
1655 static struct {
1656         const char *interface;
1657         const char *member;
1658         void (*function) (const char *path, DBusMessageIter *iter);
1659 } signal_map[] = {
1660         { DBUS_INTERFACE_DBUS,  "NameOwnerChanged",  signal_name_owner_changed },
1661
1662         { SUPPLICANT_INTERFACE, "PropertiesChanged", signal_properties_changed },
1663         { SUPPLICANT_INTERFACE, "InterfaceAdded",    signal_interface_added    },
1664         { SUPPLICANT_INTERFACE, "InterfaceCreated",  signal_interface_added    },
1665         { SUPPLICANT_INTERFACE, "InterfaceRemoved",  signal_interface_removed  },
1666
1667         { SUPPLICANT_INTERFACE ".Interface", "PropertiesChanged", signal_interface_changed },
1668         { SUPPLICANT_INTERFACE ".Interface", "ScanDone",          signal_scan_done         },
1669         { SUPPLICANT_INTERFACE ".Interface", "BSSAdded",          signal_bss_added         },
1670         { SUPPLICANT_INTERFACE ".Interface", "BSSRemoved",        signal_bss_removed       },
1671         { SUPPLICANT_INTERFACE ".Interface", "NetworkAdded",      signal_network_added     },
1672         { SUPPLICANT_INTERFACE ".Interface", "NetworkRemoved",    signal_network_removed   },
1673
1674         { SUPPLICANT_INTERFACE ".BSS", "PropertiesChanged", signal_bss_changed   },
1675
1676         { }
1677 };
1678
1679 static DBusHandlerResult g_supplicant_filter(DBusConnection *conn,
1680                                         DBusMessage *message, void *data)
1681 {
1682         DBusMessageIter iter;
1683         const char *path;
1684         int i;
1685
1686         path = dbus_message_get_path(message);
1687         if (path == NULL)
1688                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1689
1690         if (dbus_message_iter_init(message, &iter) == FALSE)
1691                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1692
1693         for (i = 0; signal_map[i].interface != NULL; i++) {
1694                 if (dbus_message_has_interface(message,
1695                                         signal_map[i].interface) == FALSE)
1696                         continue;
1697
1698                 if (dbus_message_has_member(message,
1699                                         signal_map[i].member) == FALSE)
1700                         continue;
1701
1702                 signal_map[i].function(path, &iter);
1703                 break;
1704         }
1705
1706         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
1707 }
1708
1709 struct supplicant_regdom {
1710         GSupplicantCountryCallback callback;
1711         const void *user_data;
1712 };
1713
1714 static void country_result(const char *error,
1715                                 DBusMessageIter *iter, void *user_data)
1716 {
1717         struct supplicant_regdom *regdom = user_data;
1718         char *alpha2;
1719
1720         SUPPLICANT_DBG("Country setting result");
1721
1722         if (user_data == NULL)
1723                 return;
1724
1725         if (error == NULL) {
1726                 alpha2 = (char *)regdom->user_data;
1727         } else {
1728                 SUPPLICANT_DBG("Country setting failure %s", error);
1729                 alpha2 = NULL;
1730         }
1731
1732         if (regdom->callback)
1733                 regdom->callback(alpha2);
1734
1735         g_free(regdom);
1736 }
1737
1738 static void country_params(DBusMessageIter *iter, void *user_data)
1739 {
1740         struct supplicant_regdom *regdom = user_data;
1741         const char *country;
1742
1743         country = regdom->user_data;
1744
1745         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &country);
1746 }
1747
1748 int g_supplicant_set_country(const char *alpha2,
1749                                 GSupplicantCountryCallback callback,
1750                                         const void *user_data)
1751 {
1752         struct supplicant_regdom *regdom;
1753
1754         SUPPLICANT_DBG("Country setting %s", alpha2);
1755
1756         if (system_available == FALSE)
1757                 return -EFAULT;
1758
1759         regdom = dbus_malloc0(sizeof(*regdom));
1760         if (regdom == NULL)
1761                 return -ENOMEM;
1762
1763         regdom->callback = callback;
1764         regdom->user_data = user_data;
1765
1766         return supplicant_dbus_property_set(SUPPLICANT_PATH, SUPPLICANT_INTERFACE,
1767                                         "Country", DBUS_TYPE_STRING_AS_STRING,
1768                                         country_params, country_result,
1769                                                 regdom);
1770 }
1771
1772 struct interface_data {
1773         GSupplicantInterface *interface;
1774         GSupplicantInterfaceCallback callback;
1775         void *user_data;
1776 };
1777
1778 struct interface_create_data {
1779         const char *ifname;
1780         const char *driver;
1781         GSupplicantInterface *interface;
1782         GSupplicantInterfaceCallback callback;
1783         void *user_data;
1784 };
1785
1786 struct interface_connect_data {
1787         GSupplicantInterface *interface;
1788         GSupplicantInterfaceCallback callback;
1789         GSupplicantSSID *ssid;
1790         void *user_data;
1791 };
1792
1793 static void interface_create_property(const char *key, DBusMessageIter *iter,
1794                                                         void *user_data)
1795 {
1796         struct interface_create_data *data = user_data;
1797         GSupplicantInterface *interface = data->interface;
1798
1799         if (key == NULL) {
1800                 if (data->callback != NULL)
1801                         data->callback(0, data->interface, data->user_data);
1802
1803                 dbus_free(data);
1804         }
1805
1806         interface_property(key, iter, interface);
1807 }
1808
1809 static void interface_create_result(const char *error,
1810                                 DBusMessageIter *iter, void *user_data)
1811 {
1812         struct interface_create_data *data = user_data;
1813         const char *path = NULL;
1814         int err;
1815
1816         SUPPLICANT_DBG("");
1817
1818         if (error != NULL) {
1819                 g_critical("error %s", error);
1820                 err = -EIO;
1821                 goto done;
1822         }
1823
1824         dbus_message_iter_get_basic(iter, &path);
1825         if (path == NULL) {
1826                 err = -EINVAL;
1827                 goto done;
1828         }
1829
1830         if (system_available == FALSE) {
1831                 err = -EFAULT;
1832                 goto done;
1833         }
1834
1835         data->interface = g_hash_table_lookup(interface_table, path);
1836         if (data->interface == NULL) {
1837                 data->interface = interface_alloc(path);
1838                 if (data->interface == NULL) {
1839                         err = -ENOMEM;
1840                         goto done;
1841                 }
1842         }
1843
1844         err = supplicant_dbus_property_get_all(path,
1845                                         SUPPLICANT_INTERFACE ".Interface",
1846                                         interface_create_property, data);
1847         if (err == 0)
1848                 return;
1849
1850 done:
1851         if (data->callback != NULL)
1852                 data->callback(err, NULL, data->user_data);
1853
1854         dbus_free(data);
1855 }
1856
1857 static void interface_create_params(DBusMessageIter *iter, void *user_data)
1858 {
1859         struct interface_create_data *data = user_data;
1860         DBusMessageIter dict;
1861
1862         SUPPLICANT_DBG("");
1863
1864         supplicant_dbus_dict_open(iter, &dict);
1865
1866         supplicant_dbus_dict_append_basic(&dict, "Ifname",
1867                                         DBUS_TYPE_STRING, &data->ifname);
1868
1869         if (data->driver != NULL)
1870                 supplicant_dbus_dict_append_basic(&dict, "Driver",
1871                                         DBUS_TYPE_STRING, &data->driver);
1872
1873         supplicant_dbus_dict_close(iter, &dict);
1874 }
1875
1876 static void interface_get_result(const char *error,
1877                                 DBusMessageIter *iter, void *user_data)
1878 {
1879         struct interface_create_data *data = user_data;
1880         GSupplicantInterface *interface;
1881         const char *path = NULL;
1882         int err;
1883
1884         SUPPLICANT_DBG("");
1885
1886         if (error != NULL) {
1887                 SUPPLICANT_DBG("Interface not created yet");
1888                 err = -EIO;
1889                 goto create;
1890         }
1891
1892         dbus_message_iter_get_basic(iter, &path);
1893         if (path == NULL) {
1894                 err = -EINVAL;
1895                 goto done;
1896         }
1897
1898         interface = g_hash_table_lookup(interface_table, path);
1899         if (interface == NULL) {
1900                 err = -ENOENT;
1901                 goto done;
1902         }
1903
1904         if (data->callback != NULL)
1905                 data->callback(0, interface, data->user_data);
1906
1907         dbus_free(data);
1908
1909         return;
1910
1911 create:
1912         if (system_available == FALSE) {
1913                 err = -EFAULT;
1914                 goto done;
1915         }
1916
1917         SUPPLICANT_DBG("Creating interface");
1918
1919         err = supplicant_dbus_method_call(SUPPLICANT_PATH,
1920                                                 SUPPLICANT_INTERFACE,
1921                                                 "CreateInterface",
1922                                                 interface_create_params,
1923                                                 interface_create_result, data);
1924         if (err == 0)
1925                 return;
1926
1927 done:
1928         if (data->callback != NULL)
1929                 data->callback(err, NULL, data->user_data);
1930
1931         dbus_free(data);
1932 }
1933
1934 static void interface_get_params(DBusMessageIter *iter, void *user_data)
1935 {
1936         struct interface_create_data *data = user_data;
1937
1938         SUPPLICANT_DBG("");
1939
1940         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &data->ifname);
1941 }
1942
1943 int g_supplicant_interface_create(const char *ifname, const char *driver,
1944                                         GSupplicantInterfaceCallback callback,
1945                                                         void *user_data)
1946 {
1947         struct interface_create_data *data;
1948
1949         SUPPLICANT_DBG("ifname %s", ifname);
1950
1951         if (ifname == NULL)
1952                 return -EINVAL;
1953
1954         if (system_available == FALSE)
1955                 return -EFAULT;
1956
1957         data = dbus_malloc0(sizeof(*data));
1958         if (data == NULL)
1959                 return -ENOMEM;
1960
1961         data->ifname = ifname;
1962         data->driver = driver;
1963         data->callback = callback;
1964         data->user_data = user_data;
1965
1966         return supplicant_dbus_method_call(SUPPLICANT_PATH,
1967                                                 SUPPLICANT_INTERFACE,
1968                                                 "GetInterface",
1969                                                 interface_get_params,
1970                                                 interface_get_result, data);
1971 }
1972
1973 static void interface_remove_result(const char *error,
1974                                 DBusMessageIter *iter, void *user_data)
1975 {
1976         struct interface_data *data = user_data;
1977         int err;
1978
1979         if (error != NULL) {
1980                 err = -EIO;
1981                 goto done;
1982         }
1983
1984         if (system_available == FALSE) {
1985                 err = -EFAULT;
1986                 goto done;
1987         }
1988
1989         /*
1990          * The gsupplicant interface is already freed by the InterfaceRemoved
1991          * signal callback. Simply invoke the interface_data callback.
1992          */
1993         err = 0;
1994
1995 done:
1996         if (data->callback != NULL)
1997                 data->callback(err, NULL, data->user_data);
1998
1999         dbus_free(data);
2000 }
2001
2002
2003 static void interface_remove_params(DBusMessageIter *iter, void *user_data)
2004 {
2005         struct interface_data *data = user_data;
2006
2007         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
2008                                                         &data->interface->path);
2009 }
2010
2011
2012 int g_supplicant_interface_remove(GSupplicantInterface *interface,
2013                         GSupplicantInterfaceCallback callback,
2014                                                         void *user_data)
2015 {
2016         struct interface_data *data;
2017
2018         if (interface == NULL)
2019                 return -EINVAL;
2020
2021         if (system_available == FALSE)
2022                 return -EFAULT;
2023
2024         data = dbus_malloc0(sizeof(*data));
2025         if (data == NULL)
2026                 return -ENOMEM;
2027
2028         data->interface = interface;
2029         data->callback = callback;
2030         data->user_data = user_data;
2031
2032         return supplicant_dbus_method_call(SUPPLICANT_PATH,
2033                                                 SUPPLICANT_INTERFACE,
2034                                                 "RemoveInterface",
2035                                                 interface_remove_params,
2036                                                 interface_remove_result, data);
2037 }
2038
2039 static void interface_scan_result(const char *error,
2040                                 DBusMessageIter *iter, void *user_data)
2041 {
2042         struct interface_data *data = user_data;
2043
2044         if (error != NULL) {
2045                 if (data->callback != NULL)
2046                         data->callback(-EIO, data->interface, data->user_data);
2047         } else {
2048                 data->interface->scan_callback = data->callback;
2049                 data->interface->scan_data = data->user_data;
2050         }
2051
2052         dbus_free(data);
2053 }
2054
2055 static void interface_scan_params(DBusMessageIter *iter, void *user_data)
2056 {
2057         DBusMessageIter dict;
2058         const char *type = "passive";
2059
2060         supplicant_dbus_dict_open(iter, &dict);
2061
2062         supplicant_dbus_dict_append_basic(&dict, "Type",
2063                                                 DBUS_TYPE_STRING, &type);
2064
2065         supplicant_dbus_dict_close(iter, &dict);
2066 }
2067
2068 int g_supplicant_interface_scan(GSupplicantInterface *interface,
2069                                 GSupplicantInterfaceCallback callback,
2070                                                         void *user_data)
2071 {
2072         struct interface_data *data;
2073
2074         if (interface == NULL)
2075                 return -EINVAL;
2076
2077         if (system_available == FALSE)
2078                 return -EFAULT;
2079
2080         if (interface->scanning == TRUE)
2081                 return -EALREADY;
2082
2083         switch (interface->state) {
2084         case G_SUPPLICANT_STATE_AUTHENTICATING:
2085         case G_SUPPLICANT_STATE_ASSOCIATING:
2086         case G_SUPPLICANT_STATE_ASSOCIATED:
2087         case G_SUPPLICANT_STATE_4WAY_HANDSHAKE:
2088         case G_SUPPLICANT_STATE_GROUP_HANDSHAKE:
2089                 return -EBUSY;
2090         case G_SUPPLICANT_STATE_UNKNOWN:
2091         case G_SUPPLICANT_STATE_DISCONNECTED:
2092         case G_SUPPLICANT_STATE_INACTIVE:
2093         case G_SUPPLICANT_STATE_SCANNING:
2094         case G_SUPPLICANT_STATE_COMPLETED:
2095                 break;
2096         }
2097
2098         data = dbus_malloc0(sizeof(*data));
2099         if (data == NULL)
2100                 return -ENOMEM;
2101
2102         data->interface = interface;
2103         data->callback = callback;
2104         data->user_data = user_data;
2105
2106         return supplicant_dbus_method_call(interface->path,
2107                         SUPPLICANT_INTERFACE ".Interface", "Scan",
2108                         interface_scan_params, interface_scan_result, data);
2109 }
2110
2111 static void interface_select_network_result(const char *error,
2112                                 DBusMessageIter *iter, void *user_data)
2113 {
2114         struct interface_connect_data *data = user_data;
2115
2116         SUPPLICANT_DBG("");
2117
2118         dbus_free(data);
2119 }
2120
2121 static void interface_select_network_params(DBusMessageIter *iter,
2122                                                         void *user_data)
2123 {
2124         struct interface_connect_data *data = user_data;
2125         GSupplicantInterface *interface = data->interface;
2126
2127         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
2128                                         &interface->network_path);
2129 }
2130
2131 static void interface_add_network_result(const char *error,
2132                                 DBusMessageIter *iter, void *user_data)
2133 {
2134         struct interface_connect_data *data = user_data;
2135         GSupplicantInterface *interface = data->interface;
2136         const char *path;
2137
2138         if (error != NULL)
2139                 goto error;
2140
2141         dbus_message_iter_get_basic(iter, &path);
2142         if (path == NULL)
2143                 goto error;
2144
2145         SUPPLICANT_DBG("PATH: %s", path);
2146
2147         g_free(interface->network_path);
2148         interface->network_path = g_strdup(path);
2149
2150         supplicant_dbus_method_call(data->interface->path,
2151                         SUPPLICANT_INTERFACE ".Interface", "SelectNetwork",
2152                         interface_select_network_params,
2153                         interface_select_network_result, data);
2154
2155         return;
2156
2157 error:
2158         g_free(interface->network_path);
2159         interface->network_path = NULL;
2160         g_free(data);
2161 }
2162
2163 static void add_network_security_wep(DBusMessageIter *dict,
2164                                         GSupplicantSSID *ssid)
2165 {
2166         const char *auth_alg = "OPEN SHARED";
2167         const char *key_index = "0";
2168
2169         supplicant_dbus_dict_append_basic(dict, "auth_alg",
2170                                         DBUS_TYPE_STRING, &auth_alg);
2171
2172         if (ssid->passphrase) {
2173                 int size = strlen(ssid->passphrase);
2174                 if (size == 10 || size == 26) {
2175                         unsigned char *key = g_try_malloc(13);
2176                         char tmp[3];
2177                         int i;
2178
2179                         memset(tmp, 0, sizeof(tmp));
2180                         if (key == NULL)
2181                                 size = 0;
2182
2183                         for (i = 0; i < size / 2; i++) {
2184                                 memcpy(tmp, ssid->passphrase + (i * 2), 2);
2185                                 key[i] = (unsigned char) strtol(tmp, NULL, 16);
2186                         }
2187
2188                         supplicant_dbus_dict_append_fixed_array(dict,
2189                                                         "wep_key0",
2190                                                         DBUS_TYPE_BYTE,
2191                                                         &key, size / 2);
2192                         g_free(key);
2193                 } else if (size == 5 || size == 13) {
2194                         unsigned char *key = g_try_malloc(13);
2195                         int i;
2196
2197                         if (key == NULL)
2198                                 size = 0;
2199
2200                         for (i = 0; i < size; i++)
2201                                 key[i] = (unsigned char) ssid->passphrase[i];
2202
2203                         supplicant_dbus_dict_append_fixed_array(dict,
2204                                                                 "wep_key0",
2205                                                                 DBUS_TYPE_BYTE,
2206                                                                 &key, size);
2207                         g_free(key);
2208                 } else
2209                         supplicant_dbus_dict_append_basic(dict,
2210                                                         "wep_key0",
2211                                                         DBUS_TYPE_STRING,
2212                                                         &ssid->passphrase);
2213
2214                 supplicant_dbus_dict_append_basic(dict, "wep_tx_keyidx",
2215                                         DBUS_TYPE_STRING, &key_index);
2216         }
2217 }
2218
2219 static void add_network_security_psk(DBusMessageIter *dict,
2220                                         GSupplicantSSID *ssid)
2221 {
2222         if (ssid->passphrase && strlen(ssid->passphrase) > 0)
2223                         supplicant_dbus_dict_append_basic(dict, "psk",
2224                                                 DBUS_TYPE_STRING,
2225                                                         &ssid->passphrase);
2226 }
2227
2228 static void add_network_security_tls(DBusMessageIter *dict,
2229                                         GSupplicantSSID *ssid)
2230 {
2231         /*
2232          * For TLS, we at least need:
2233          *              The client certificate
2234          *              The client private key file
2235          *              The client private key file password
2236          *
2237          * The Authority certificate is optional.
2238          */
2239         if (ssid->client_cert_path == NULL)
2240                 return;
2241
2242         if (ssid->private_key_path == NULL)
2243                 return;
2244
2245         if (ssid->private_key_passphrase == NULL)
2246                 return;
2247
2248         if (ssid->ca_cert_path)
2249                 supplicant_dbus_dict_append_basic(dict, "ca_cert",
2250                                         DBUS_TYPE_STRING, &ssid->ca_cert_path);
2251
2252         supplicant_dbus_dict_append_basic(dict, "private_key",
2253                                                 DBUS_TYPE_STRING,
2254                                                 &ssid->private_key_path);
2255         supplicant_dbus_dict_append_basic(dict, "private_key_passwd",
2256                                                 DBUS_TYPE_STRING,
2257                                                 &ssid->private_key_passphrase);
2258         supplicant_dbus_dict_append_basic(dict, "client_cert",
2259                                                 DBUS_TYPE_STRING,
2260                                                 &ssid->client_cert_path);
2261 }
2262
2263 static void add_network_security_peap(DBusMessageIter *dict,
2264                                         GSupplicantSSID *ssid)
2265 {
2266         char *phase2_auth;
2267
2268         /*
2269          * For PEAP/TTLS, we at least need
2270          *              The authority certificate
2271          *              The 2nd phase authentication method
2272          *              The 2nd phase passphrase
2273          *
2274          * The Client certificate is optional although strongly required
2275          * When setting it, we need in addition
2276          *              The Client private key file
2277          *              The Client private key file password
2278          */
2279         if (ssid->passphrase == NULL)
2280                 return;
2281
2282         if (ssid->ca_cert_path == NULL)
2283                 return;
2284
2285         if (ssid->phase2_auth == NULL)
2286                 return;
2287
2288         if (ssid->client_cert_path) {
2289                 if (ssid->private_key_path == NULL)
2290                         return;
2291
2292                 if (ssid->private_key_passphrase == NULL)
2293                         return;
2294
2295                 supplicant_dbus_dict_append_basic(dict, "client_cert",
2296                                                 DBUS_TYPE_STRING,
2297                                                 &ssid->client_cert_path);
2298
2299                 supplicant_dbus_dict_append_basic(dict, "private_key",
2300                                                 DBUS_TYPE_STRING,
2301                                                 &ssid->private_key_path);
2302
2303                 supplicant_dbus_dict_append_basic(dict, "private_key_passwd",
2304                                                 DBUS_TYPE_STRING,
2305                                                 &ssid->private_key_passphrase);
2306
2307         }
2308
2309         phase2_auth = g_strdup_printf("\"auth=%s\"", ssid->phase2_auth);
2310
2311         supplicant_dbus_dict_append_basic(dict, "password",
2312                                                 DBUS_TYPE_STRING,
2313                                                 &ssid->passphrase);
2314
2315         supplicant_dbus_dict_append_basic(dict, "ca_cert",
2316                                                 DBUS_TYPE_STRING,
2317                                                 &ssid->ca_cert_path);
2318
2319         supplicant_dbus_dict_append_basic(dict, "phase2",
2320                                                 DBUS_TYPE_STRING,
2321                                                 &ssid->phase2_auth);
2322
2323         g_free(phase2_auth);
2324 }
2325
2326 static void add_network_security_eap(DBusMessageIter *dict,
2327                                         GSupplicantSSID *ssid)
2328 {
2329         char *eap_value;
2330
2331         if (ssid->eap == NULL || ssid->identity == NULL)
2332                 return;
2333
2334         if (g_strcmp0(ssid->eap, "tls") == 0) {
2335                 add_network_security_tls(dict, ssid);
2336         } else if (g_strcmp0(ssid->eap, "peap") == 0 ||
2337                                 g_strcmp0(ssid->eap, "ttls") == 0) {
2338                 add_network_security_peap(dict, ssid);
2339         } else
2340                 return;
2341
2342         eap_value = g_ascii_strup(ssid->eap, -1);
2343
2344         supplicant_dbus_dict_append_basic(dict, "eap",
2345                                                 DBUS_TYPE_STRING,
2346                                                 &eap_value);
2347         supplicant_dbus_dict_append_basic(dict, "identity",
2348                                                 DBUS_TYPE_STRING,
2349                                                 &ssid->identity);
2350
2351         g_free(eap_value);
2352 }
2353
2354 static void add_network_security(DBusMessageIter *dict, GSupplicantSSID *ssid)
2355 {
2356         char *key_mgmt;
2357
2358         switch (ssid->security) {
2359         case G_SUPPLICANT_SECURITY_UNKNOWN:
2360         case G_SUPPLICANT_SECURITY_NONE:
2361         case G_SUPPLICANT_SECURITY_WEP:
2362                 key_mgmt = "NONE";
2363                 add_network_security_wep(dict, ssid);
2364                 break;
2365         case G_SUPPLICANT_SECURITY_PSK:
2366                 key_mgmt = "WPA-PSK";
2367                 add_network_security_psk(dict, ssid);
2368                 break;
2369         case G_SUPPLICANT_SECURITY_IEEE8021X:
2370                 key_mgmt = "WPA-EAP";
2371                 add_network_security_eap(dict, ssid);
2372                 break;
2373         }
2374
2375         supplicant_dbus_dict_append_basic(dict, "key_mgmt",
2376                                 DBUS_TYPE_STRING, &key_mgmt);
2377 }
2378
2379 static void interface_add_network_params(DBusMessageIter *iter, void *user_data)
2380 {
2381         DBusMessageIter dict;
2382         dbus_uint32_t scan_ssid = 1;
2383         struct interface_connect_data *data = user_data;
2384         GSupplicantSSID *ssid = data->ssid;
2385
2386         supplicant_dbus_dict_open(iter, &dict);
2387
2388         supplicant_dbus_dict_append_basic(&dict, "scan_ssid",
2389                                          DBUS_TYPE_UINT32, &scan_ssid);
2390
2391         add_network_security(&dict, ssid);
2392
2393         supplicant_dbus_dict_append_fixed_array(&dict, "ssid",
2394                                         DBUS_TYPE_BYTE, &ssid->ssid,
2395                                                 ssid->ssid_len);
2396
2397         supplicant_dbus_dict_close(iter, &dict);
2398 }
2399
2400 int g_supplicant_interface_connect(GSupplicantInterface *interface,
2401                                 GSupplicantSSID *ssid,
2402                                 GSupplicantInterfaceCallback callback,
2403                                                         void *user_data)
2404 {
2405         struct interface_connect_data *data;
2406         int ret;
2407
2408         if (interface == NULL)
2409                 return -EINVAL;
2410
2411         if (system_available == FALSE)
2412                 return -EFAULT;
2413
2414         /* TODO: Check if we're already connected and switch */
2415
2416         data = dbus_malloc0(sizeof(*data));
2417         if (data == NULL)
2418                 return -ENOMEM;
2419
2420         data->interface = interface;
2421         data->callback = callback;
2422         data->ssid = ssid;
2423         data->user_data = user_data;
2424
2425         ret = supplicant_dbus_method_call(interface->path,
2426                         SUPPLICANT_INTERFACE ".Interface", "AddNetwork",
2427                         interface_add_network_params,
2428                         interface_add_network_result, data);
2429         if (ret < 0)
2430                 return ret;
2431
2432         return -EINPROGRESS;
2433 }
2434
2435 static void network_remove_result(const char *error,
2436                                 DBusMessageIter *iter, void *user_data)
2437 {
2438         struct interface_data *data = user_data;
2439         int result = 0;
2440
2441         SUPPLICANT_DBG("");
2442
2443         if (error != NULL)
2444                 result = -EIO;
2445
2446         if (data->callback != NULL)
2447                 data->callback(result, data->interface, data->user_data);
2448
2449         dbus_free(data);
2450 }
2451
2452 static void network_remove_params(DBusMessageIter *iter, void *user_data)
2453 {
2454         struct interface_data *data = user_data;
2455         const char *path = data->interface->network_path;
2456
2457         SUPPLICANT_DBG("path %s", path);
2458
2459         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH, &path);
2460 }
2461
2462 static int network_remove(struct interface_data *data)
2463 {
2464         GSupplicantInterface *interface = data->interface;
2465
2466         SUPPLICANT_DBG("");
2467
2468         return supplicant_dbus_method_call(interface->path,
2469                         SUPPLICANT_INTERFACE ".Interface", "RemoveNetwork",
2470                         network_remove_params, network_remove_result, data);
2471 }
2472
2473 static void interface_disconnect_result(const char *error,
2474                                 DBusMessageIter *iter, void *user_data)
2475 {
2476         struct interface_data *data = user_data;
2477
2478         SUPPLICANT_DBG("");
2479
2480         if (error != NULL && data->callback != NULL)
2481                 data->callback(-EIO, data->interface, data->user_data);
2482
2483         network_remove(data);
2484 }
2485
2486 int g_supplicant_interface_disconnect(GSupplicantInterface *interface,
2487                                         GSupplicantInterfaceCallback callback,
2488                                                         void *user_data)
2489 {
2490         struct interface_data *data;
2491
2492         SUPPLICANT_DBG("");
2493
2494         if (interface == NULL)
2495                 return -EINVAL;
2496
2497         if (system_available == FALSE)
2498                 return -EFAULT;
2499
2500         data = dbus_malloc0(sizeof(*data));
2501         if (data == NULL)
2502                 return -ENOMEM;
2503
2504         data->interface = interface;
2505         data->callback = callback;
2506         data->user_data = user_data;
2507
2508         return supplicant_dbus_method_call(interface->path,
2509                         SUPPLICANT_INTERFACE ".Interface", "Disconnect",
2510                                 NULL, interface_disconnect_result, data);
2511 }
2512
2513
2514 static const char *g_supplicant_rule0 = "type=signal,"
2515                                         "path=" DBUS_PATH_DBUS ","
2516                                         "sender=" DBUS_SERVICE_DBUS ","
2517                                         "interface=" DBUS_INTERFACE_DBUS ","
2518                                         "member=NameOwnerChanged,"
2519                                         "arg0=" SUPPLICANT_SERVICE;
2520 static const char *g_supplicant_rule1 = "type=signal,"
2521                         "interface=" SUPPLICANT_INTERFACE;
2522 static const char *g_supplicant_rule2 = "type=signal,"
2523                         "interface=" SUPPLICANT_INTERFACE ".Interface";
2524 static const char *g_supplicant_rule3 = "type=signal,"
2525                         "interface=" SUPPLICANT_INTERFACE ".Interface.WPS";
2526 static const char *g_supplicant_rule4 = "type=signal,"
2527                         "interface=" SUPPLICANT_INTERFACE ".BSS";
2528 static const char *g_supplicant_rule5 = "type=signal,"
2529                         "interface=" SUPPLICANT_INTERFACE ".Network";
2530
2531 static void invoke_introspect_method(void)
2532 {
2533         DBusMessage *message;
2534
2535         message = dbus_message_new_method_call(SUPPLICANT_SERVICE,
2536                                         SUPPLICANT_PATH,
2537                                         DBUS_INTERFACE_INTROSPECTABLE,
2538                                         "Introspect");
2539
2540         if (message == NULL)
2541                 return;
2542
2543         dbus_message_set_no_reply(message, TRUE);
2544         dbus_connection_send(connection, message, NULL);
2545         dbus_message_unref(message);
2546 }
2547
2548 int g_supplicant_register(const GSupplicantCallbacks *callbacks)
2549 {
2550         connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
2551         if (connection == NULL)
2552                 return -EIO;
2553
2554         if (dbus_connection_add_filter(connection,
2555                                 g_supplicant_filter, NULL, NULL) == FALSE) {
2556                 dbus_connection_unref(connection);
2557                 connection = NULL;
2558                 return -EIO;
2559         }
2560
2561         callbacks_pointer = callbacks;
2562         eap_methods = 0;
2563
2564         interface_table = g_hash_table_new_full(g_str_hash, g_str_equal,
2565                                                 NULL, remove_interface);
2566
2567         bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
2568                                                                 NULL, NULL);
2569
2570         supplicant_dbus_setup(connection);
2571
2572         dbus_bus_add_match(connection, g_supplicant_rule0, NULL);
2573         dbus_bus_add_match(connection, g_supplicant_rule1, NULL);
2574         dbus_bus_add_match(connection, g_supplicant_rule2, NULL);
2575         dbus_bus_add_match(connection, g_supplicant_rule3, NULL);
2576         dbus_bus_add_match(connection, g_supplicant_rule4, NULL);
2577         dbus_bus_add_match(connection, g_supplicant_rule5, NULL);
2578         dbus_connection_flush(connection);
2579
2580         if (dbus_bus_name_has_owner(connection,
2581                                         SUPPLICANT_SERVICE, NULL) == TRUE) {
2582                 system_available = TRUE;
2583                 supplicant_dbus_property_get_all(SUPPLICANT_PATH,
2584                                                 SUPPLICANT_INTERFACE,
2585                                                 service_property, NULL);
2586         } else
2587                 invoke_introspect_method();
2588
2589         return 0;
2590 }
2591
2592 static void unregister_interface_remove_params(DBusMessageIter *iter,
2593                                                 void *user_data)
2594 {
2595         const char *path = user_data;
2596
2597         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
2598                                                         &path);
2599 }
2600
2601
2602 static void unregister_remove_interface(gpointer key, gpointer value,
2603                                                 gpointer user_data)
2604 {
2605         GSupplicantInterface *interface = value;
2606
2607         supplicant_dbus_method_call(SUPPLICANT_PATH,
2608                                         SUPPLICANT_INTERFACE,
2609                                         "RemoveInterface",
2610                                         unregister_interface_remove_params,
2611                                                 NULL, interface->path);
2612 }
2613
2614 void g_supplicant_unregister(const GSupplicantCallbacks *callbacks)
2615 {
2616         SUPPLICANT_DBG("");
2617
2618         if (connection != NULL) {
2619                 dbus_bus_remove_match(connection, g_supplicant_rule5, NULL);
2620                 dbus_bus_remove_match(connection, g_supplicant_rule4, NULL);
2621                 dbus_bus_remove_match(connection, g_supplicant_rule3, NULL);
2622                 dbus_bus_remove_match(connection, g_supplicant_rule2, NULL);
2623                 dbus_bus_remove_match(connection, g_supplicant_rule1, NULL);
2624                 dbus_bus_remove_match(connection, g_supplicant_rule0, NULL);
2625                 dbus_connection_flush(connection);
2626
2627                 dbus_connection_remove_filter(connection,
2628                                                 g_supplicant_filter, NULL);
2629         }
2630
2631         if (bss_mapping != NULL) {
2632                 g_hash_table_destroy(bss_mapping);
2633                 bss_mapping = NULL;
2634         }
2635
2636         if (interface_table != NULL) {
2637                 g_hash_table_foreach(interface_table,   
2638                                         unregister_remove_interface, NULL);
2639                 g_hash_table_destroy(interface_table);
2640                 interface_table = NULL;
2641         }
2642
2643         if (system_available == TRUE)
2644                 callback_system_killed();
2645
2646         if (connection != NULL) {
2647                 dbus_connection_unref(connection);
2648                 connection = NULL;
2649         }
2650
2651         callbacks_pointer = NULL;
2652         eap_methods = 0;
2653 }