gsupplicant: Add support for background scanning parameters
[platform/upstream/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 #include <ctype.h>
33
34 #include <glib.h>
35 #include <gdbus.h>
36
37 #include "dbus.h"
38 #include "gsupplicant.h"
39
40 #define TIMEOUT 5000
41
42 #define IEEE80211_CAP_ESS       0x0001
43 #define IEEE80211_CAP_IBSS      0x0002
44 #define IEEE80211_CAP_PRIVACY   0x0010
45
46 static DBusConnection *connection;
47
48 static const GSupplicantCallbacks *callbacks_pointer;
49
50 static dbus_bool_t system_available = FALSE;
51 static dbus_bool_t system_ready = FALSE;
52
53 static dbus_int32_t debug_level;
54 static dbus_bool_t debug_timestamp = FALSE;
55 static dbus_bool_t debug_showkeys = FALSE;
56
57 static const char *debug_strings[] = {
58         "msgdump", "debug", "info", "warning", "error", NULL
59 };
60
61 static unsigned int eap_methods;
62
63 struct strvalmap {
64         const char *str;
65         unsigned int val;
66 };
67
68 static struct strvalmap eap_method_map[] = {
69         { "MD5",        G_SUPPLICANT_EAP_METHOD_MD5     },
70         { "TLS",        G_SUPPLICANT_EAP_METHOD_TLS     },
71         { "MSCHAPV2",   G_SUPPLICANT_EAP_METHOD_MSCHAPV2        },
72         { "PEAP",       G_SUPPLICANT_EAP_METHOD_PEAP    },
73         { "TTLS",       G_SUPPLICANT_EAP_METHOD_TTLS    },
74         { "GTC",        G_SUPPLICANT_EAP_METHOD_GTC     },
75         { "OTP",        G_SUPPLICANT_EAP_METHOD_OTP     },
76         { "LEAP",       G_SUPPLICANT_EAP_METHOD_LEAP    },
77         { "WSC",        G_SUPPLICANT_EAP_METHOD_WSC     },
78         { }
79 };
80
81 static struct strvalmap keymgmt_map[] = {
82         { "none",               G_SUPPLICANT_KEYMGMT_NONE               },
83         { "ieee8021x",          G_SUPPLICANT_KEYMGMT_IEEE8021X  },
84         { "wpa-none",           G_SUPPLICANT_KEYMGMT_WPA_NONE   },
85         { "wpa-psk",            G_SUPPLICANT_KEYMGMT_WPA_PSK    },
86         { "wpa-psk-sha256",     G_SUPPLICANT_KEYMGMT_WPA_PSK_256        },
87         { "wpa-ft-psk",         G_SUPPLICANT_KEYMGMT_WPA_FT_PSK },
88         { "wpa-ft-eap",         G_SUPPLICANT_KEYMGMT_WPA_FT_EAP },
89         { "wpa-eap",            G_SUPPLICANT_KEYMGMT_WPA_EAP    },
90         { "wpa-eap-sha256",     G_SUPPLICANT_KEYMGMT_WPA_EAP_256        },
91         { "wps",                G_SUPPLICANT_KEYMGMT_WPS                },
92         { }
93 };
94
95 static struct strvalmap authalg_capa_map[] = {
96         { "open",       G_SUPPLICANT_CAPABILITY_AUTHALG_OPEN    },
97         { "shared",     G_SUPPLICANT_CAPABILITY_AUTHALG_SHARED  },
98         { "leap",       G_SUPPLICANT_CAPABILITY_AUTHALG_LEAP    },
99         { }
100 };
101
102 static struct strvalmap proto_capa_map[] = {
103         { "wpa",        G_SUPPLICANT_CAPABILITY_PROTO_WPA               },
104         { "rsn",        G_SUPPLICANT_CAPABILITY_PROTO_RSN               },
105         { }
106 };
107
108 static struct strvalmap group_map[] = {
109         { "wep40",      G_SUPPLICANT_GROUP_WEP40        },
110         { "wep104",     G_SUPPLICANT_GROUP_WEP104       },
111         { "tkip",       G_SUPPLICANT_GROUP_TKIP },
112         { "ccmp",       G_SUPPLICANT_GROUP_CCMP },
113         { }
114 };
115
116 static struct strvalmap pairwise_map[] = {
117         { "none",       G_SUPPLICANT_PAIRWISE_NONE      },
118         { "tkip",       G_SUPPLICANT_PAIRWISE_TKIP      },
119         { "ccmp",       G_SUPPLICANT_PAIRWISE_CCMP      },
120         { }
121 };
122
123 static struct strvalmap scan_capa_map[] = {
124         { "active",     G_SUPPLICANT_CAPABILITY_SCAN_ACTIVE     },
125         { "passive",    G_SUPPLICANT_CAPABILITY_SCAN_PASSIVE    },
126         { "ssid",       G_SUPPLICANT_CAPABILITY_SCAN_SSID               },
127         { }
128 };
129
130 static struct strvalmap mode_capa_map[] = {
131         { "infrastructure",     G_SUPPLICANT_CAPABILITY_MODE_INFRA      },
132         { "ad-hoc",             G_SUPPLICANT_CAPABILITY_MODE_IBSS       },
133         { "ap",                 G_SUPPLICANT_CAPABILITY_MODE_AP         },
134         { }
135 };
136
137 static GHashTable *interface_table;
138 static GHashTable *bss_mapping;
139
140 struct _GSupplicantWpsCredentials {
141         unsigned char ssid[32];
142         unsigned int ssid_len;
143         char *key;
144 };
145
146 struct _GSupplicantInterface {
147         char *path;
148         char *network_path;
149         unsigned int keymgmt_capa;
150         unsigned int authalg_capa;
151         unsigned int proto_capa;
152         unsigned int group_capa;
153         unsigned int pairwise_capa;
154         unsigned int scan_capa;
155         unsigned int mode_capa;
156         unsigned int max_scan_ssids;
157         dbus_bool_t ready;
158         GSupplicantState state;
159         dbus_bool_t scanning;
160         GSupplicantInterfaceCallback scan_callback;
161         void *scan_data;
162         int apscan;
163         char *ifname;
164         char *driver;
165         char *bridge;
166         struct _GSupplicantWpsCredentials wps_cred;
167         GSupplicantWpsState wps_state;
168         GHashTable *network_table;
169         GHashTable *net_mapping;
170         GHashTable *bss_mapping;
171         void *data;
172 };
173
174 struct g_supplicant_bss {
175         GSupplicantInterface *interface;
176         char *path;
177         unsigned char bssid[6];
178         unsigned char ssid[32];
179         unsigned int ssid_len;
180         dbus_uint16_t frequency;
181         dbus_uint32_t maxrate;
182         dbus_int16_t signal;
183         GSupplicantMode mode;
184         GSupplicantSecurity security;
185         unsigned int keymgmt;
186         unsigned int pairwise;
187         unsigned int group;
188         dbus_bool_t privacy;
189         dbus_bool_t psk;
190         dbus_bool_t ieee8021x;
191 };
192
193 struct _GSupplicantNetwork {
194         GSupplicantInterface *interface;
195         char *path;
196         char *group;
197         char *name;
198         unsigned char ssid[32];
199         unsigned int ssid_len;
200         dbus_int16_t signal;
201         dbus_uint16_t frequency;
202         struct g_supplicant_bss *best_bss;
203         GSupplicantMode mode;
204         GSupplicantSecurity security;
205         dbus_bool_t wps;
206         GHashTable *bss_table;
207         GHashTable *config_table;
208 };
209
210 static inline void debug(const char *format, ...)
211 {
212         char str[256];
213         va_list ap;
214
215         if (callbacks_pointer->debug == NULL)
216                 return;
217
218         va_start(ap, format);
219
220         if (vsnprintf(str, sizeof(str), format, ap) > 0)
221                 callbacks_pointer->debug(str);
222
223         va_end(ap);
224 }
225
226 #define SUPPLICANT_DBG(fmt, arg...) \
227         debug("%s:%s() " fmt, __FILE__, __FUNCTION__ , ## arg);
228
229 static GSupplicantMode string2mode(const char *mode)
230 {
231         if (mode == NULL)
232                 return G_SUPPLICANT_MODE_UNKNOWN;
233
234         if (g_str_equal(mode, "infrastructure") == TRUE)
235                 return G_SUPPLICANT_MODE_INFRA;
236         else if (g_str_equal(mode, "ad-hoc") == TRUE)
237                 return G_SUPPLICANT_MODE_IBSS;
238
239         return G_SUPPLICANT_MODE_UNKNOWN;
240 }
241
242 static const char *mode2string(GSupplicantMode mode)
243 {
244         switch (mode) {
245         case G_SUPPLICANT_MODE_UNKNOWN:
246                 break;
247         case G_SUPPLICANT_MODE_INFRA:
248                 return "managed";
249         case G_SUPPLICANT_MODE_IBSS:
250                 return "adhoc";
251         case G_SUPPLICANT_MODE_MASTER:
252                 return "ap";
253         }
254
255         return NULL;
256 }
257
258 static const char *security2string(GSupplicantSecurity security)
259 {
260         switch (security) {
261         case G_SUPPLICANT_SECURITY_UNKNOWN:
262                 break;
263         case G_SUPPLICANT_SECURITY_NONE:
264                 return "none";
265         case G_SUPPLICANT_SECURITY_WEP:
266                 return "wep";
267         case G_SUPPLICANT_SECURITY_PSK:
268                 return "psk";
269         case G_SUPPLICANT_SECURITY_IEEE8021X:
270                 return "ieee8021x";
271         }
272
273         return NULL;
274 }
275
276 static GSupplicantState string2state(const char *state)
277 {
278         if (state == NULL)
279                 return G_SUPPLICANT_STATE_UNKNOWN;
280
281         if (g_str_equal(state, "unknown") == TRUE)
282                 return G_SUPPLICANT_STATE_UNKNOWN;
283         else if (g_str_equal(state, "disconnected") == TRUE)
284                 return G_SUPPLICANT_STATE_DISCONNECTED;
285         else if (g_str_equal(state, "inactive") == TRUE)
286                 return G_SUPPLICANT_STATE_INACTIVE;
287         else if (g_str_equal(state, "scanning") == TRUE)
288                 return G_SUPPLICANT_STATE_SCANNING;
289         else if (g_str_equal(state, "authenticating") == TRUE)
290                 return G_SUPPLICANT_STATE_AUTHENTICATING;
291         else if (g_str_equal(state, "associating") == TRUE)
292                 return G_SUPPLICANT_STATE_ASSOCIATING;
293         else if (g_str_equal(state, "associated") == TRUE)
294                 return G_SUPPLICANT_STATE_ASSOCIATED;
295         else if (g_str_equal(state, "group_handshake") == TRUE)
296                 return G_SUPPLICANT_STATE_GROUP_HANDSHAKE;
297         else if (g_str_equal(state, "4way_handshake") == TRUE)
298                 return G_SUPPLICANT_STATE_4WAY_HANDSHAKE;
299         else if (g_str_equal(state, "completed") == TRUE)
300                 return G_SUPPLICANT_STATE_COMPLETED;
301
302         return G_SUPPLICANT_STATE_UNKNOWN;
303 }
304
305 static void callback_system_ready(void)
306 {
307         if (system_ready == TRUE)
308                 return;
309
310         system_ready = TRUE;
311
312         if (callbacks_pointer == NULL)
313                 return;
314
315         if (callbacks_pointer->system_ready == NULL)
316                 return;
317
318         callbacks_pointer->system_ready();
319 }
320
321 static void callback_system_killed(void)
322 {
323         system_ready = FALSE;
324
325         if (callbacks_pointer == NULL)
326                 return;
327
328         if (callbacks_pointer->system_killed == NULL)
329                 return;
330
331         callbacks_pointer->system_killed();
332 }
333
334 static void callback_interface_added(GSupplicantInterface *interface)
335 {
336         SUPPLICANT_DBG("");
337
338         if (callbacks_pointer == NULL)
339                 return;
340
341         if (callbacks_pointer->interface_added == NULL)
342                 return;
343
344         callbacks_pointer->interface_added(interface);
345 }
346
347 static void callback_interface_state(GSupplicantInterface *interface)
348 {
349         if (callbacks_pointer == NULL)
350                 return;
351
352         if (callbacks_pointer->interface_state == NULL)
353                 return;
354
355         callbacks_pointer->interface_state(interface);
356 }
357
358 static void callback_interface_removed(GSupplicantInterface *interface)
359 {
360         if (callbacks_pointer == NULL)
361                 return;
362
363         if (callbacks_pointer->interface_removed == NULL)
364                 return;
365
366         callbacks_pointer->interface_removed(interface);
367 }
368
369 static void callback_scan_started(GSupplicantInterface *interface)
370 {
371         if (callbacks_pointer == NULL)
372                 return;
373
374         if (callbacks_pointer->scan_started == NULL)
375                 return;
376
377         callbacks_pointer->scan_started(interface);
378 }
379
380 static void callback_scan_finished(GSupplicantInterface *interface)
381 {
382         if (callbacks_pointer == NULL)
383                 return;
384
385         if (callbacks_pointer->scan_finished == NULL)
386                 return;
387
388         callbacks_pointer->scan_finished(interface);
389 }
390
391 static void callback_network_added(GSupplicantNetwork *network)
392 {
393         if (callbacks_pointer == NULL)
394                 return;
395
396         if (callbacks_pointer->network_added == NULL)
397                 return;
398
399         callbacks_pointer->network_added(network);
400 }
401
402 static void callback_network_removed(GSupplicantNetwork *network)
403 {
404         if (callbacks_pointer == NULL)
405                 return;
406
407         if (callbacks_pointer->network_removed == NULL)
408                 return;
409
410         callbacks_pointer->network_removed(network);
411 }
412
413 static void callback_network_changed(GSupplicantNetwork *network,
414                                         const char *property)
415 {
416         if (callbacks_pointer == NULL)
417                 return;
418
419         if (callbacks_pointer->network_changed == NULL)
420                 return;
421
422         callbacks_pointer->network_changed(network, property);
423 }
424
425 static void remove_interface(gpointer data)
426 {
427         GSupplicantInterface *interface = data;
428
429         g_hash_table_destroy(interface->bss_mapping);
430         g_hash_table_destroy(interface->net_mapping);
431         g_hash_table_destroy(interface->network_table);
432
433         callback_interface_removed(interface);
434
435         g_free(interface->wps_cred.key);
436         g_free(interface->path);
437         g_free(interface->network_path);
438         g_free(interface->ifname);
439         g_free(interface->driver);
440         g_free(interface->bridge);
441         g_free(interface);
442 }
443
444 static void remove_network(gpointer data)
445 {
446         GSupplicantNetwork *network = data;
447
448         g_hash_table_destroy(network->bss_table);
449
450         callback_network_removed(network);
451
452         g_hash_table_destroy(network->config_table);
453
454         g_free(network->path);
455         g_free(network->group);
456         g_free(network->name);
457         g_free(network);
458 }
459
460 static void remove_bss(gpointer data)
461 {
462         struct g_supplicant_bss *bss = data;
463
464         g_free(bss->path);
465         g_free(bss);
466 }
467
468 static void debug_strvalmap(const char *label, struct strvalmap *map,
469                                                         unsigned int val)
470 {
471         int i;
472
473         for (i = 0; map[i].str != NULL; i++) {
474                 if (val & map[i].val)
475                         SUPPLICANT_DBG("%s: %s", label, map[i].str);
476         }
477 }
478
479 static void interface_capability_keymgmt(DBusMessageIter *iter, void *user_data)
480 {
481         GSupplicantInterface *interface = user_data;
482         const char *str = NULL;
483         int i;
484
485         dbus_message_iter_get_basic(iter, &str);
486         if (str == NULL)
487                 return;
488
489         for (i = 0; keymgmt_map[i].str != NULL; i++)
490                 if (strcmp(str, keymgmt_map[i].str) == 0) {
491                         interface->keymgmt_capa |= keymgmt_map[i].val;
492                         break;
493                 }
494 }
495
496 static void interface_capability_authalg(DBusMessageIter *iter, void *user_data)
497 {
498         GSupplicantInterface *interface = user_data;
499         const char *str = NULL;
500         int i;
501
502         dbus_message_iter_get_basic(iter, &str);
503         if (str == NULL)
504                 return;
505
506         for (i = 0; authalg_capa_map[i].str != NULL; i++)
507                 if (strcmp(str, authalg_capa_map[i].str) == 0) {
508                         interface->authalg_capa |= authalg_capa_map[i].val;
509                         break;
510                 }
511 }
512
513 static void interface_capability_proto(DBusMessageIter *iter, void *user_data)
514 {
515         GSupplicantInterface *interface = user_data;
516         const char *str = NULL;
517         int i;
518
519         dbus_message_iter_get_basic(iter, &str);
520         if (str == NULL)
521                 return;
522
523         for (i = 0; proto_capa_map[i].str != NULL; i++)
524                 if (strcmp(str, proto_capa_map[i].str) == 0) {
525                         interface->proto_capa |= proto_capa_map[i].val;
526                         break;
527                 }
528 }
529
530 static void interface_capability_pairwise(DBusMessageIter *iter,
531                                                         void *user_data)
532 {
533         GSupplicantInterface *interface = user_data;
534         const char *str = NULL;
535         int i;
536
537         dbus_message_iter_get_basic(iter, &str);
538         if (str == NULL)
539                 return;
540
541         for (i = 0; pairwise_map[i].str != NULL; i++)
542                 if (strcmp(str, pairwise_map[i].str) == 0) {
543                         interface->pairwise_capa |= pairwise_map[i].val;
544                         break;
545                 }
546 }
547
548 static void interface_capability_group(DBusMessageIter *iter, void *user_data)
549 {
550         GSupplicantInterface *interface = user_data;
551         const char *str = NULL;
552         int i;
553
554         dbus_message_iter_get_basic(iter, &str);
555         if (str == NULL)
556                 return;
557
558         for (i = 0; group_map[i].str != NULL; i++)
559                 if (strcmp(str, group_map[i].str) == 0) {
560                         interface->group_capa |= group_map[i].val;
561                         break;
562                 }
563 }
564
565 static void interface_capability_scan(DBusMessageIter *iter, void *user_data)
566 {
567         GSupplicantInterface *interface = user_data;
568         const char *str = NULL;
569         int i;
570
571         dbus_message_iter_get_basic(iter, &str);
572         if (str == NULL)
573                 return;
574
575         for (i = 0; scan_capa_map[i].str != NULL; i++)
576                 if (strcmp(str, scan_capa_map[i].str) == 0) {
577                         interface->scan_capa |= scan_capa_map[i].val;
578                         break;
579                 }
580 }
581
582 static void interface_capability_mode(DBusMessageIter *iter, void *user_data)
583 {
584         GSupplicantInterface *interface = user_data;
585         const char *str = NULL;
586         int i;
587
588         dbus_message_iter_get_basic(iter, &str);
589         if (str == NULL)
590                 return;
591
592         for (i = 0; mode_capa_map[i].str != NULL; i++)
593                 if (strcmp(str, mode_capa_map[i].str) == 0) {
594                         interface->mode_capa |= mode_capa_map[i].val;
595                         break;
596                 }
597 }
598
599 static void interface_capability(const char *key, DBusMessageIter *iter,
600                                                         void *user_data)
601 {
602         GSupplicantInterface *interface = user_data;
603
604         if (key == NULL)
605                 return;
606
607         if (g_strcmp0(key, "KeyMgmt") == 0)
608                 supplicant_dbus_array_foreach(iter,
609                                 interface_capability_keymgmt, interface);
610         else if (g_strcmp0(key, "AuthAlg") == 0)
611                 supplicant_dbus_array_foreach(iter,
612                                 interface_capability_authalg, interface);
613         else if (g_strcmp0(key, "Protocol") == 0)
614                 supplicant_dbus_array_foreach(iter,
615                                 interface_capability_proto, interface);
616         else if (g_strcmp0(key, "Pairwise") == 0)
617                 supplicant_dbus_array_foreach(iter,
618                                 interface_capability_pairwise, interface);
619         else if (g_strcmp0(key, "Group") == 0)
620                 supplicant_dbus_array_foreach(iter,
621                                 interface_capability_group, interface);
622         else if (g_strcmp0(key, "Scan") == 0)
623                 supplicant_dbus_array_foreach(iter,
624                                 interface_capability_scan, interface);
625         else if (g_strcmp0(key, "Modes") == 0)
626                 supplicant_dbus_array_foreach(iter,
627                                 interface_capability_mode, interface);
628         else if (g_strcmp0(key, "MaxScanSSID") == 0) {
629                 dbus_int32_t max_scan_ssid;
630
631                 dbus_message_iter_get_basic(iter, &max_scan_ssid);
632                 interface->max_scan_ssids = max_scan_ssid;
633
634         } else
635                 SUPPLICANT_DBG("key %s type %c",
636                                 key, dbus_message_iter_get_arg_type(iter));
637 }
638
639 static void set_apscan(DBusMessageIter *iter, void *user_data)
640 {
641         unsigned int ap_scan = *(unsigned int *)user_data;
642
643         dbus_message_iter_append_basic(iter, DBUS_TYPE_UINT32, &ap_scan);
644 }
645
646 int g_supplicant_interface_set_apscan(GSupplicantInterface *interface,
647                                                         unsigned int ap_scan)
648 {
649         return supplicant_dbus_property_set(interface->path,
650                         SUPPLICANT_INTERFACE ".Interface",
651                                 "ApScan", DBUS_TYPE_UINT32_AS_STRING,
652                                         set_apscan, NULL, &ap_scan);
653 }
654
655 void g_supplicant_interface_set_data(GSupplicantInterface *interface,
656                                                                 void *data)
657 {
658         if (interface == NULL)
659                 return;
660
661         interface->data = data;
662 }
663
664 void *g_supplicant_interface_get_data(GSupplicantInterface *interface)
665 {
666         if (interface == NULL)
667                 return NULL;
668
669         return interface->data;
670 }
671
672 const char *g_supplicant_interface_get_ifname(GSupplicantInterface *interface)
673 {
674         if (interface == NULL)
675                 return NULL;
676
677         return interface->ifname;
678 }
679
680 const char *g_supplicant_interface_get_driver(GSupplicantInterface *interface)
681 {
682         if (interface == NULL)
683                 return NULL;
684
685         return interface->driver;
686 }
687
688 GSupplicantState g_supplicant_interface_get_state(
689                                         GSupplicantInterface *interface)
690 {
691         if (interface == NULL)
692                 return G_SUPPLICANT_STATE_UNKNOWN;
693
694         return interface->state;
695 }
696
697 const char *g_supplicant_interface_get_wps_key(GSupplicantInterface *interface)
698 {
699         if (interface == NULL)
700                 return NULL;
701
702         return (const char *)interface->wps_cred.key;
703 }
704
705 const void *g_supplicant_interface_get_wps_ssid(GSupplicantInterface *interface,
706                                                         unsigned int *ssid_len)
707 {
708         if (ssid_len == NULL)
709                 return NULL;
710
711         if (interface == NULL || interface->wps_cred.ssid == NULL) {
712                 *ssid_len = 0;
713                 return NULL;
714         }
715
716         *ssid_len = interface->wps_cred.ssid_len;
717         return interface->wps_cred.ssid;
718 }
719
720 GSupplicantWpsState g_supplicant_interface_get_wps_state(
721                                         GSupplicantInterface *interface)
722 {
723         if (interface == NULL)
724                 return G_SUPPLICANT_WPS_STATE_UNKNOWN;
725
726         return interface->wps_state;
727 }
728
729 unsigned int g_supplicant_interface_get_mode(GSupplicantInterface *interface)
730 {
731         if (interface == NULL)
732                 return 0;
733
734         return interface->mode_capa;
735 }
736
737 unsigned int g_supplicant_interface_get_max_scan_ssids(
738                                 GSupplicantInterface *interface)
739 {
740         if (interface == NULL)
741                 return 0;
742
743         return interface->max_scan_ssids;
744 }
745
746 static void set_network_enabled(DBusMessageIter *iter, void *user_data)
747 {
748         dbus_bool_t enable = *(dbus_bool_t *)user_data;
749
750         dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &enable);
751 }
752
753 int g_supplicant_interface_enable_selected_network(GSupplicantInterface *interface,
754                                                         dbus_bool_t enable)
755 {
756         if (interface == NULL)
757                 return -1;
758
759         if (interface->network_path == NULL)
760                 return -1;
761
762         SUPPLICANT_DBG(" ");
763         return supplicant_dbus_property_set(interface->network_path,
764                                 SUPPLICANT_INTERFACE ".Network",
765                                 "Enabled", DBUS_TYPE_BOOLEAN_AS_STRING,
766                                 set_network_enabled, NULL, &enable);
767 }
768
769 dbus_bool_t g_supplicant_interface_get_ready(GSupplicantInterface *interface)
770 {
771         if (interface == NULL)
772                 return FALSE;
773
774         return interface->ready;
775 }
776
777 GSupplicantInterface *g_supplicant_network_get_interface(
778                                         GSupplicantNetwork *network)
779 {
780         if (network == NULL)
781                 return NULL;
782
783         return network->interface;
784 }
785
786 const char *g_supplicant_network_get_name(GSupplicantNetwork *network)
787 {
788         if (network == NULL || network->name == NULL)
789                 return "";
790
791         return network->name;
792 }
793
794 const char *g_supplicant_network_get_identifier(GSupplicantNetwork *network)
795 {
796         if (network == NULL || network->group == NULL)
797                 return "";
798
799         return network->group;
800 }
801
802 const char *g_supplicant_network_get_path(GSupplicantNetwork *network)
803 {
804         if (network == NULL || network->path == NULL)
805                 return NULL;
806
807         return network->path;
808 }
809
810 const char *g_supplicant_network_get_mode(GSupplicantNetwork *network)
811 {
812         if (network == NULL)
813                 return G_SUPPLICANT_MODE_UNKNOWN;
814
815         return mode2string(network->mode);
816 }
817
818 const char *g_supplicant_network_get_security(GSupplicantNetwork *network)
819 {
820         if (network == NULL)
821                 return G_SUPPLICANT_SECURITY_UNKNOWN;
822
823         return security2string(network->security);
824 }
825
826 const void *g_supplicant_network_get_ssid(GSupplicantNetwork *network,
827                                                 unsigned int *ssid_len)
828 {
829         if (network == NULL || network->ssid == NULL) {
830                 *ssid_len = 0;
831                 return NULL;
832         }
833
834         *ssid_len = network->ssid_len;
835         return network->ssid;
836 }
837
838 dbus_int16_t g_supplicant_network_get_signal(GSupplicantNetwork *network)
839 {
840         if (network == NULL)
841                 return 0;
842
843         return network->signal;
844 }
845
846 dbus_uint16_t g_supplicant_network_get_frequency(GSupplicantNetwork *network)
847 {
848         if (network == NULL)
849                 return 0;
850
851         return network->frequency;
852 }
853
854 dbus_bool_t g_supplicant_network_get_wps(GSupplicantNetwork *network)
855 {
856         if (network == NULL)
857                 return FALSE;
858
859         return network->wps;
860 }
861
862 static void merge_network(GSupplicantNetwork *network)
863 {
864         GString *str;
865         const char *ssid, *mode, *key_mgmt;
866         unsigned int i, ssid_len;
867         char *group;
868
869         ssid = g_hash_table_lookup(network->config_table, "ssid");
870         mode = g_hash_table_lookup(network->config_table, "mode");
871         key_mgmt = g_hash_table_lookup(network->config_table, "key_mgmt");
872
873         SUPPLICANT_DBG("ssid %s mode %s", ssid, mode);
874
875         if (ssid != NULL)
876                 ssid_len = strlen(ssid);
877         else
878                 ssid_len = 0;
879
880         str = g_string_sized_new((ssid_len * 2) + 24);
881         if (str == NULL)
882                 return;
883
884         for (i = 0; i < ssid_len; i++)
885                 g_string_append_printf(str, "%02x", ssid[i]);
886
887         if (g_strcmp0(mode, "0") == 0)
888                 g_string_append_printf(str, "_managed");
889         else if (g_strcmp0(mode, "1") == 0)
890                 g_string_append_printf(str, "_adhoc");
891
892         if (g_strcmp0(key_mgmt, "WPA-PSK") == 0)
893                 g_string_append_printf(str, "_psk");
894
895         group = g_string_free(str, FALSE);
896
897         SUPPLICANT_DBG("%s", group);
898
899         g_free(group);
900
901         g_hash_table_destroy(network->config_table);
902
903         g_free(network->path);
904         g_free(network);
905 }
906
907 static void network_property(const char *key, DBusMessageIter *iter,
908                                                         void *user_data)
909 {
910         GSupplicantNetwork *network = user_data;
911
912         if (network->interface == NULL)
913                 return;
914
915         if (key == NULL) {
916                 merge_network(network);
917                 return;
918         }
919
920         if (g_strcmp0(key, "Enabled") == 0) {
921                 dbus_bool_t enabled = FALSE;
922
923                 dbus_message_iter_get_basic(iter, &enabled);
924         } else if (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_STRING) {
925                 const char *str = NULL;
926
927                 dbus_message_iter_get_basic(iter, &str);
928                 if (str != NULL) {
929                         g_hash_table_replace(network->config_table,
930                                                 g_strdup(key), g_strdup(str));
931                 }
932         } else
933                 SUPPLICANT_DBG("key %s type %c",
934                                 key, dbus_message_iter_get_arg_type(iter));
935 }
936
937 static void interface_network_added(DBusMessageIter *iter, void *user_data)
938 {
939         GSupplicantInterface *interface = user_data;
940         GSupplicantNetwork *network;
941         const char *path = NULL;
942
943         SUPPLICANT_DBG("");
944
945         dbus_message_iter_get_basic(iter, &path);
946         if (path == NULL)
947                 return;
948
949         if (g_strcmp0(path, "/") == 0)
950                 return;
951
952         network = g_hash_table_lookup(interface->net_mapping, path);
953         if (network != NULL)
954                 return;
955
956         network = g_try_new0(GSupplicantNetwork, 1);
957         if (network == NULL)
958                 return;
959
960         network->interface = interface;
961         network->path = g_strdup(path);
962
963         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
964                                                         g_free, g_free);
965
966         dbus_message_iter_next(iter);
967         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
968                 supplicant_dbus_property_foreach(iter, network_property,
969                                                                 network);
970                 network_property(NULL, NULL, network);
971                 return;
972         }
973
974         supplicant_dbus_property_get_all(path,
975                                 SUPPLICANT_INTERFACE ".Network",
976                                                 network_property, network);
977 }
978
979 static void interface_network_removed(DBusMessageIter *iter, void *user_data)
980 {
981         GSupplicantInterface *interface = user_data;
982         GSupplicantNetwork *network;
983         const char *path = NULL;
984
985         dbus_message_iter_get_basic(iter, &path);
986         if (path == NULL)
987                 return;
988
989         network = g_hash_table_lookup(interface->net_mapping, path);
990         if (network == NULL)
991                 return;
992
993         g_hash_table_remove(interface->net_mapping, path);
994 }
995
996 static char *create_name(unsigned char *ssid, int ssid_len)
997 {
998         GString *string;
999         const gchar *remainder, *invalid;
1000         int valid_bytes, remaining_bytes;
1001
1002         if (ssid_len < 1 || ssid[0] == '\0')
1003                 return g_strdup("");
1004
1005         string = NULL;
1006         remainder = (const gchar *)ssid;
1007         remaining_bytes = ssid_len;
1008
1009         while (remaining_bytes != 0) {
1010                 if (g_utf8_validate(remainder, remaining_bytes,
1011                                         &invalid) == TRUE) {
1012                         break;
1013                 }
1014
1015                 valid_bytes = invalid - remainder;
1016
1017                 if (string == NULL)
1018                         string = g_string_sized_new(remaining_bytes);
1019
1020                 g_string_append_len(string, remainder, valid_bytes);
1021
1022                 /* append U+FFFD REPLACEMENT CHARACTER */
1023                 g_string_append(string, "\357\277\275");
1024
1025                 remaining_bytes -= valid_bytes + 1;
1026                 remainder = invalid + 1;
1027         }
1028
1029         if (string == NULL)
1030                 return g_strndup((const gchar *)ssid, ssid_len + 1);
1031
1032         g_string_append(string, remainder);
1033
1034         return g_string_free(string, FALSE);
1035 }
1036
1037 static char *create_group(struct g_supplicant_bss *bss)
1038 {
1039         GString *str;
1040         unsigned int i;
1041         const char *mode, *security;
1042
1043         str = g_string_sized_new((bss->ssid_len * 2) + 24);
1044         if (str == NULL)
1045                 return NULL;
1046
1047         if (bss->ssid_len > 0 && bss->ssid[0] != '\0') {
1048                 for (i = 0; i < bss->ssid_len; i++)
1049                         g_string_append_printf(str, "%02x", bss->ssid[i]);
1050         } else
1051                 g_string_append_printf(str, "hidden");
1052
1053         mode = mode2string(bss->mode);
1054         if (mode != NULL)
1055                 g_string_append_printf(str, "_%s", mode);
1056
1057         security = security2string(bss->security);
1058         if (security != NULL)
1059                 g_string_append_printf(str, "_%s", security);
1060
1061         return g_string_free(str, FALSE);
1062 }
1063
1064 static void add_bss_to_network(struct g_supplicant_bss *bss)
1065 {
1066         GSupplicantInterface *interface = bss->interface;
1067         GSupplicantNetwork *network;
1068         char *group;
1069
1070         group = create_group(bss);
1071         if (group == NULL)
1072                 return;
1073
1074         network = g_hash_table_lookup(interface->network_table, group);
1075         if (network != NULL) {
1076                 g_free(group);
1077                 goto done;
1078         }
1079
1080         network = g_try_new0(GSupplicantNetwork, 1);
1081         if (network == NULL) {
1082                 g_free(group);
1083                 return;
1084         }
1085
1086         network->interface = interface;
1087         if (network->path == NULL)
1088                 network->path = g_strdup(bss->path);
1089         network->group = group;
1090         network->name = create_name(bss->ssid, bss->ssid_len);
1091         network->mode = bss->mode;
1092         network->security = bss->security;
1093         network->ssid_len = bss->ssid_len;
1094         memcpy(network->ssid, bss->ssid, bss->ssid_len);
1095         network->signal = bss->signal;
1096         network->frequency = bss->frequency;
1097         network->best_bss = bss;
1098
1099         network->wps = FALSE;
1100         if ((bss->keymgmt & G_SUPPLICANT_KEYMGMT_WPS) != 0)
1101                 network->wps = TRUE;
1102
1103         network->bss_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1104                                                         NULL, remove_bss);
1105
1106         network->config_table = g_hash_table_new_full(g_str_hash, g_str_equal,
1107                                                         g_free, g_free);
1108
1109         g_hash_table_replace(interface->network_table,
1110                                                 network->group, network);
1111
1112         callback_network_added(network);
1113
1114 done:
1115         if (bss->signal > network->signal) {
1116                 network->signal = bss->signal;
1117                 network->best_bss = bss;
1118                 callback_network_changed(network, "Signal");
1119         }
1120
1121         g_hash_table_replace(interface->bss_mapping, bss->path, network);
1122         g_hash_table_replace(network->bss_table, bss->path, bss);
1123
1124         g_hash_table_replace(bss_mapping, bss->path, interface);
1125 }
1126
1127 static void bss_rates(DBusMessageIter *iter, void *user_data)
1128 {
1129         struct g_supplicant_bss *bss = user_data;
1130         dbus_uint32_t rate = 0;
1131
1132         dbus_message_iter_get_basic(iter, &rate);
1133         if (rate == 0)
1134                 return;
1135
1136         if (rate > bss->maxrate)
1137                 bss->maxrate = rate;
1138 }
1139
1140 static void bss_keymgmt(DBusMessageIter *iter, void *user_data)
1141 {
1142         struct g_supplicant_bss *bss = user_data;
1143         const char *str = NULL;
1144         int i;
1145
1146         dbus_message_iter_get_basic(iter, &str);
1147         if (str == NULL)
1148                 return;
1149
1150         for (i = 0; keymgmt_map[i].str != NULL; i++)
1151                 if (strcmp(str, keymgmt_map[i].str) == 0) {
1152                         bss->keymgmt |= keymgmt_map[i].val;
1153                         break;
1154                 }
1155 }
1156
1157 static void bss_group(DBusMessageIter *iter, void *user_data)
1158 {
1159         struct g_supplicant_bss *bss = user_data;
1160         const char *str = NULL;
1161         int i;
1162
1163         dbus_message_iter_get_basic(iter, &str);
1164         if (str == NULL)
1165                 return;
1166
1167         for (i = 0; group_map[i].str != NULL; i++)
1168                 if (strcmp(str, group_map[i].str) == 0) {
1169                         bss->group |= group_map[i].val;
1170                         break;
1171                 }
1172 }
1173
1174 static void bss_pairwise(DBusMessageIter *iter, void *user_data)
1175 {
1176         struct g_supplicant_bss *bss = user_data;
1177         const char *str = NULL;
1178         int i;
1179
1180         dbus_message_iter_get_basic(iter, &str);
1181         if (str == NULL)
1182                 return;
1183
1184         for (i = 0; pairwise_map[i].str != NULL; i++)
1185                 if (strcmp(str, pairwise_map[i].str) == 0) {
1186                         bss->pairwise |= pairwise_map[i].val;
1187                         break;
1188                 }
1189 }
1190
1191 static void bss_wpa(const char *key, DBusMessageIter *iter,
1192                         void *user_data)
1193 {
1194         if (g_strcmp0(key, "KeyMgmt") == 0)
1195                 supplicant_dbus_array_foreach(iter, bss_keymgmt, user_data);
1196         else if (g_strcmp0(key, "Group") == 0)
1197                 supplicant_dbus_array_foreach(iter, bss_group, user_data);
1198         else if (g_strcmp0(key, "Pairwise") == 0)
1199                 supplicant_dbus_array_foreach(iter, bss_pairwise, user_data);
1200
1201 }
1202
1203 static unsigned int get_tlv(unsigned char *ie, unsigned int ie_size,
1204                                                         unsigned int type)
1205 {
1206         unsigned int len = 0;
1207
1208         while (len + 4 < ie_size) {
1209                 unsigned int hi = ie[len];
1210                 unsigned int lo = ie[len + 1];
1211                 unsigned int tmp_type = (hi << 8) + lo;
1212                 unsigned int v_len = 0;
1213
1214                 /* hi and lo are used to recreate an unsigned int
1215                  * based on 2 8bits length unsigned int. */
1216
1217                 hi = ie[len + 2];
1218                 lo = ie[len + 3];
1219                 v_len = (hi << 8) + lo;
1220
1221                 if (tmp_type == type) {
1222                         unsigned int ret_value = 0;
1223                         unsigned char *value = (unsigned char *)&ret_value;
1224
1225                         SUPPLICANT_DBG("IE: match type 0x%x", type);
1226
1227                         /* Verifying length relevance */
1228                         if (v_len > sizeof(unsigned int) ||
1229                                 len + 4 + v_len > ie_size)
1230                                 break;
1231
1232                         memcpy(value, ie + len + 4, v_len);
1233
1234                         SUPPLICANT_DBG("returning 0x%x", ret_value);
1235                         return ret_value;
1236                 }
1237
1238                 len += v_len + 4;
1239         }
1240
1241         SUPPLICANT_DBG("returning 0");
1242         return 0;
1243 }
1244
1245 static void bss_process_ies(DBusMessageIter *iter, void *user_data)
1246 {
1247         struct g_supplicant_bss *bss = user_data;
1248         const unsigned char WPS_OUI[] = { 0x00, 0x50, 0xf2, 0x04 };
1249         unsigned char *ie, *ie_end;
1250         DBusMessageIter array;
1251         int ie_len;
1252
1253 #define WMM_WPA1_WPS_INFO 221
1254 #define WPS_INFO_MIN_LEN  6
1255 #define WPS_VERSION_TLV   0x104A
1256 #define WPS_STATE_TLV     0x1044
1257 #define WPS_VERSION       0x10
1258
1259         dbus_message_iter_recurse(iter, &array);
1260         dbus_message_iter_get_fixed_array(&array, &ie, &ie_len);
1261
1262         if (ie == NULL || ie_len < 2)
1263                 return;
1264
1265         for (ie_end = ie + ie_len; ie < ie_end && ie + ie[1] + 1 <= ie_end;
1266                                                         ie += ie[1] + 2) {
1267
1268                 if (ie[0] != WMM_WPA1_WPS_INFO || ie[1] < WPS_INFO_MIN_LEN ||
1269                         memcmp(ie+2, WPS_OUI, sizeof(WPS_OUI)) != 0)
1270                         continue;
1271
1272                 SUPPLICANT_DBG("IE: match WPS_OUI");
1273
1274                 if (get_tlv(&ie[6], ie[1],
1275                                 WPS_VERSION_TLV) == WPS_VERSION &&
1276                         get_tlv(&ie[6], ie[1],
1277                                 WPS_STATE_TLV) != 0)
1278                         bss->keymgmt |= G_SUPPLICANT_KEYMGMT_WPS;
1279         }
1280 }
1281
1282 static void bss_property(const char *key, DBusMessageIter *iter,
1283                                                         void *user_data)
1284 {
1285         struct g_supplicant_bss *bss = user_data;
1286
1287         if (bss->interface == NULL)
1288                 return;
1289
1290         SUPPLICANT_DBG("key %s", key);
1291
1292         if (key == NULL) {
1293                 if (bss->ieee8021x == TRUE)
1294                         bss->security = G_SUPPLICANT_SECURITY_IEEE8021X;
1295                 else if (bss->psk == TRUE)
1296                         bss->security = G_SUPPLICANT_SECURITY_PSK;
1297                 else if (bss->privacy == TRUE)
1298                         bss->security = G_SUPPLICANT_SECURITY_WEP;
1299                 else
1300                         bss->security = G_SUPPLICANT_SECURITY_NONE;
1301
1302                 add_bss_to_network(bss);
1303                 return;
1304         }
1305
1306         if (g_strcmp0(key, "BSSID") == 0) {
1307                 DBusMessageIter array;
1308                 unsigned char *addr;
1309                 int addr_len;
1310
1311                 dbus_message_iter_recurse(iter, &array);
1312                 dbus_message_iter_get_fixed_array(&array, &addr, &addr_len);
1313
1314                 if (addr_len == 6)
1315                         memcpy(bss->bssid, addr, addr_len);
1316         } else if (g_strcmp0(key, "SSID") == 0) {
1317                 DBusMessageIter array;
1318                 unsigned char *ssid;
1319                 int ssid_len;
1320
1321                 dbus_message_iter_recurse(iter, &array);
1322                 dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
1323
1324                 if (ssid_len > 0 && ssid_len < 33) {
1325                         memcpy(bss->ssid, ssid, ssid_len);
1326                         bss->ssid_len = ssid_len;
1327                 } else {
1328                         memset(bss->ssid, 0, sizeof(bss->ssid));
1329                         bss->ssid_len = 0;
1330                 }
1331         } else if (g_strcmp0(key, "Capabilities") == 0) {
1332                 dbus_uint16_t capabilities = 0x0000;
1333
1334                 dbus_message_iter_get_basic(iter, &capabilities);
1335
1336                 if (capabilities & IEEE80211_CAP_ESS)
1337                         bss->mode = G_SUPPLICANT_MODE_INFRA;
1338                 else if (capabilities & IEEE80211_CAP_IBSS)
1339                         bss->mode = G_SUPPLICANT_MODE_IBSS;
1340
1341                 if (capabilities & IEEE80211_CAP_PRIVACY)
1342                         bss->privacy = TRUE;
1343         } else if (g_strcmp0(key, "Mode") == 0) {
1344                 const char *mode = NULL;
1345
1346                 dbus_message_iter_get_basic(iter, &mode);
1347                 bss->mode = string2mode(mode);
1348         } else if (g_strcmp0(key, "Frequency") == 0) {
1349                 dbus_uint16_t frequency = 0;
1350
1351                 dbus_message_iter_get_basic(iter, &frequency);
1352                 bss->frequency = frequency;
1353         } else if (g_strcmp0(key, "Signal") == 0) {
1354                 dbus_int16_t signal = 0;
1355
1356                 dbus_message_iter_get_basic(iter, &signal);
1357
1358                 bss->signal = signal;
1359         } else if (g_strcmp0(key, "Level") == 0) {
1360                 dbus_int32_t level = 0;
1361
1362                 dbus_message_iter_get_basic(iter, &level);
1363         } else if (g_strcmp0(key, "Rates") == 0) {
1364                 supplicant_dbus_array_foreach(iter, bss_rates, bss);
1365         } else if (g_strcmp0(key, "MaxRate") == 0) {
1366                 dbus_uint32_t maxrate = 0;
1367
1368                 dbus_message_iter_get_basic(iter, &maxrate);
1369                 if (maxrate != 0)
1370                         bss->maxrate = maxrate;
1371         } else if (g_strcmp0(key, "Privacy") == 0) {
1372                 dbus_bool_t privacy = FALSE;
1373
1374                 dbus_message_iter_get_basic(iter, &privacy);
1375                 bss->privacy = privacy;
1376         } else if ((g_strcmp0(key, "RSN") == 0) ||
1377                         (g_strcmp0(key, "WPA") == 0)) {
1378                 supplicant_dbus_property_foreach(iter, bss_wpa, bss);
1379
1380                 if (bss->keymgmt &
1381                         (G_SUPPLICANT_KEYMGMT_WPA_EAP |
1382                                 G_SUPPLICANT_KEYMGMT_WPA_FT_EAP |
1383                                 G_SUPPLICANT_KEYMGMT_WPA_EAP_256))
1384                         bss->ieee8021x = TRUE;
1385
1386                 if (bss->keymgmt &
1387                         (G_SUPPLICANT_KEYMGMT_WPA_PSK |
1388                                 G_SUPPLICANT_KEYMGMT_WPA_FT_PSK |
1389                                 G_SUPPLICANT_KEYMGMT_WPA_PSK_256))
1390                         bss->psk = TRUE;
1391         } else if (g_strcmp0(key, "IEs") == 0)
1392                 bss_process_ies(iter, bss);
1393         else
1394                 SUPPLICANT_DBG("key %s type %c",
1395                                 key, dbus_message_iter_get_arg_type(iter));
1396 }
1397
1398 static struct g_supplicant_bss *interface_bss_added(DBusMessageIter *iter,
1399                                                         void *user_data)
1400 {
1401         GSupplicantInterface *interface = user_data;
1402         GSupplicantNetwork *network;
1403         struct g_supplicant_bss *bss;
1404         const char *path = NULL;
1405
1406         SUPPLICANT_DBG("");
1407
1408         dbus_message_iter_get_basic(iter, &path);
1409         if (path == NULL)
1410                 return NULL;
1411
1412         if (g_strcmp0(path, "/") == 0)
1413                 return NULL;
1414
1415         SUPPLICANT_DBG("%s", path);
1416
1417         network = g_hash_table_lookup(interface->bss_mapping, path);
1418         if (network != NULL) {
1419                 bss = g_hash_table_lookup(network->bss_table, path);
1420                 if (bss != NULL)
1421                         return NULL;
1422         }
1423
1424         bss = g_try_new0(struct g_supplicant_bss, 1);
1425         if (bss == NULL)
1426                 return NULL;
1427
1428         bss->interface = interface;
1429         bss->path = g_strdup(path);
1430
1431         return bss;
1432 }
1433
1434 static void interface_bss_added_with_keys(DBusMessageIter *iter,
1435                                                 void *user_data)
1436 {
1437         struct g_supplicant_bss *bss;
1438
1439         SUPPLICANT_DBG("");
1440
1441         bss = interface_bss_added(iter, user_data);
1442         if (bss == NULL)
1443                 return;
1444
1445         dbus_message_iter_next(iter);
1446
1447         if (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_INVALID)
1448                 return;
1449
1450         supplicant_dbus_property_foreach(iter, bss_property, bss);
1451         bss_property(NULL, NULL, bss);
1452 }
1453
1454 static void interface_bss_added_without_keys(DBusMessageIter *iter,
1455                                                 void *user_data)
1456 {
1457         struct g_supplicant_bss *bss;
1458
1459         SUPPLICANT_DBG("");
1460
1461         bss = interface_bss_added(iter, user_data);
1462         if (bss == NULL)
1463                 return;
1464
1465         supplicant_dbus_property_get_all(bss->path,
1466                                         SUPPLICANT_INTERFACE ".BSS",
1467                                                         bss_property, bss);
1468 }
1469
1470 static void update_signal(gpointer key, gpointer value,
1471                                                 gpointer user_data)
1472 {
1473         struct g_supplicant_bss *bss = value;
1474         GSupplicantNetwork *network = user_data;
1475
1476         if (bss->signal > network->signal) {
1477                 network->signal = bss->signal;
1478                 network->best_bss = bss;
1479         }
1480 }
1481
1482 static void update_network_signal(GSupplicantNetwork *network)
1483 {
1484         if (g_hash_table_size(network->bss_table) <= 1)
1485                 return;
1486
1487         g_hash_table_foreach(network->bss_table,
1488                                 update_signal, network);
1489
1490         SUPPLICANT_DBG("New network signal %d", network->signal);
1491 }
1492
1493 static void interface_bss_removed(DBusMessageIter *iter, void *user_data)
1494 {
1495         GSupplicantInterface *interface = user_data;
1496         GSupplicantNetwork *network;
1497         const char *path = NULL;
1498
1499         dbus_message_iter_get_basic(iter, &path);
1500         if (path == NULL)
1501                 return;
1502
1503         network = g_hash_table_lookup(interface->bss_mapping, path);
1504         if (network == NULL)
1505                 return;
1506
1507         g_hash_table_remove(bss_mapping, path);
1508
1509         g_hash_table_remove(interface->bss_mapping, path);
1510         g_hash_table_remove(network->bss_table, path);
1511
1512         update_network_signal(network);
1513
1514         if (g_hash_table_size(network->bss_table) == 0)
1515                 g_hash_table_remove(interface->network_table, network->group);
1516 }
1517
1518 static void interface_property(const char *key, DBusMessageIter *iter,
1519                                                         void *user_data)
1520 {
1521         GSupplicantInterface *interface = user_data;
1522
1523         if (interface == NULL)
1524                 return;
1525
1526         SUPPLICANT_DBG("%s", key);
1527
1528         if (key == NULL) {
1529                 debug_strvalmap("KeyMgmt capability", keymgmt_map,
1530                                                 interface->keymgmt_capa);
1531                 debug_strvalmap("AuthAlg capability", authalg_capa_map,
1532                                                 interface->authalg_capa);
1533                 debug_strvalmap("Protocol capability", proto_capa_map,
1534                                                 interface->proto_capa);
1535                 debug_strvalmap("Pairwise capability", pairwise_map,
1536                                                 interface->pairwise_capa);
1537                 debug_strvalmap("Group capability", group_map,
1538                                                 interface->group_capa);
1539                 debug_strvalmap("Scan capability", scan_capa_map,
1540                                                 interface->scan_capa);
1541                 debug_strvalmap("Mode capability", mode_capa_map,
1542                                                 interface->mode_capa);
1543
1544                 interface->ready = TRUE;
1545                 callback_interface_added(interface);
1546                 return;
1547         }
1548
1549         if (g_strcmp0(key, "Capabilities") == 0) {
1550                 supplicant_dbus_property_foreach(iter, interface_capability,
1551                                                                 interface);
1552         } else if (g_strcmp0(key, "State") == 0) {
1553                 const char *str = NULL;
1554
1555                 dbus_message_iter_get_basic(iter, &str);
1556                 if (str != NULL)
1557                         if (string2state(str) != interface->state) {
1558                                 interface->state = string2state(str);
1559                                 callback_interface_state(interface);
1560                         }
1561
1562                 SUPPLICANT_DBG("state %s (%d)", str, interface->state);
1563         } else if (g_strcmp0(key, "Scanning") == 0) {
1564                 dbus_bool_t scanning = FALSE;
1565
1566                 dbus_message_iter_get_basic(iter, &scanning);
1567                 interface->scanning = scanning;
1568
1569                 if (interface->ready == TRUE) {
1570                         if (interface->scanning == TRUE)
1571                                 callback_scan_started(interface);
1572                         else
1573                                 callback_scan_finished(interface);
1574                 }
1575         } else if (g_strcmp0(key, "ApScan") == 0) {
1576                 int apscan = 1;
1577
1578                 dbus_message_iter_get_basic(iter, &apscan);
1579                 interface->apscan = apscan;
1580         } else if (g_strcmp0(key, "Ifname") == 0) {
1581                 const char *str = NULL;
1582
1583                 dbus_message_iter_get_basic(iter, &str);
1584                 if (str != NULL) {
1585                         g_free(interface->ifname);
1586                         interface->ifname = g_strdup(str);
1587                 }
1588         } else if (g_strcmp0(key, "Driver") == 0) {
1589                 const char *str = NULL;
1590
1591                 dbus_message_iter_get_basic(iter, &str);
1592                 if (str != NULL) {
1593                         g_free(interface->driver);
1594                         interface->driver = g_strdup(str);
1595                 }
1596         } else if (g_strcmp0(key, "BridgeIfname") == 0) {
1597                 const char *str = NULL;
1598
1599                 dbus_message_iter_get_basic(iter, &str);
1600                 if (str != NULL) {
1601                         g_free(interface->bridge);
1602                         interface->bridge = g_strdup(str);
1603                 }
1604         } else if (g_strcmp0(key, "CurrentBSS") == 0) {
1605                 interface_bss_added_without_keys(iter, interface);
1606         } else if (g_strcmp0(key, "CurrentNetwork") == 0) {
1607                 interface_network_added(iter, interface);
1608         } else if (g_strcmp0(key, "BSSs") == 0) {
1609                 supplicant_dbus_array_foreach(iter, interface_bss_added_without_keys,
1610                                                                 interface);
1611         } else if (g_strcmp0(key, "Blobs") == 0) {
1612                 /* Nothing */
1613         } else if (g_strcmp0(key, "Networks") == 0) {
1614                 supplicant_dbus_array_foreach(iter, interface_network_added,
1615                                                                 interface);
1616         } else
1617                 SUPPLICANT_DBG("key %s type %c",
1618                                 key, dbus_message_iter_get_arg_type(iter));
1619 }
1620
1621 static void scan_network_update(DBusMessageIter *iter, void *user_data)
1622 {
1623         GSupplicantInterface *interface = user_data;
1624         GSupplicantNetwork *network;
1625         char *path;
1626
1627         if (iter == NULL)
1628                 return;
1629
1630         dbus_message_iter_get_basic(iter, &path);
1631
1632         if (path == NULL)
1633                 return;
1634
1635         if (g_strcmp0(path, "/") == 0)
1636                 return;
1637
1638         /* Update the network details based on scan BSS data */
1639         network = g_hash_table_lookup(interface->bss_mapping, path);
1640         if (network != NULL)
1641                 callback_network_added(network);
1642 }
1643
1644 static void scan_bss_data(const char *key, DBusMessageIter *iter,
1645                                 void *user_data)
1646 {
1647         GSupplicantInterface *interface = user_data;
1648
1649         if (iter)
1650                 supplicant_dbus_array_foreach(iter, scan_network_update,
1651                                                 interface);
1652
1653         if (interface->scan_callback != NULL)
1654                 interface->scan_callback(0, interface, interface->scan_data);
1655
1656         interface->scan_callback = NULL;
1657         interface->scan_data = NULL;
1658 }
1659
1660 static GSupplicantInterface *interface_alloc(const char *path)
1661 {
1662         GSupplicantInterface *interface;
1663
1664         interface = g_try_new0(GSupplicantInterface, 1);
1665         if (interface == NULL)
1666                 return NULL;
1667
1668         interface->path = g_strdup(path);
1669
1670         interface->network_table = g_hash_table_new_full(g_str_hash,
1671                                         g_str_equal, NULL, remove_network);
1672
1673         interface->net_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1674                                                                 NULL, NULL);
1675         interface->bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
1676                                                                 NULL, NULL);
1677
1678         g_hash_table_replace(interface_table, interface->path, interface);
1679
1680         return interface;
1681 }
1682
1683 static void interface_added(DBusMessageIter *iter, void *user_data)
1684 {
1685         GSupplicantInterface *interface;
1686         const char *path = NULL;
1687
1688         SUPPLICANT_DBG("");
1689
1690         dbus_message_iter_get_basic(iter, &path);
1691         if (path == NULL)
1692                 return;
1693
1694         if (g_strcmp0(path, "/") == 0)
1695                 return;
1696
1697         interface = g_hash_table_lookup(interface_table, path);
1698         if (interface != NULL)
1699                 return;
1700
1701         interface = interface_alloc(path);
1702         if (interface == NULL)
1703                 return;
1704
1705         dbus_message_iter_next(iter);
1706         if (dbus_message_iter_get_arg_type(iter) != DBUS_TYPE_INVALID) {
1707                 supplicant_dbus_property_foreach(iter, interface_property,
1708                                                                 interface);
1709                 interface_property(NULL, NULL, interface);
1710                 return;
1711         }
1712
1713         supplicant_dbus_property_get_all(path,
1714                                         SUPPLICANT_INTERFACE ".Interface",
1715                                                 interface_property, interface);
1716 }
1717
1718 static void interface_removed(DBusMessageIter *iter, void *user_data)
1719 {
1720         const char *path = NULL;
1721
1722         dbus_message_iter_get_basic(iter, &path);
1723         if (path == NULL)
1724                 return;
1725
1726         g_hash_table_remove(interface_table, path);
1727 }
1728
1729 static void eap_method(DBusMessageIter *iter, void *user_data)
1730 {
1731         const char *str = NULL;
1732         int i;
1733
1734         dbus_message_iter_get_basic(iter, &str);
1735         if (str == NULL)
1736                 return;
1737
1738         for (i = 0; eap_method_map[i].str != NULL; i++)
1739                 if (strcmp(str, eap_method_map[i].str) == 0) {
1740                         eap_methods |= eap_method_map[i].val;
1741                         break;
1742                 }
1743 }
1744
1745 static void service_property(const char *key, DBusMessageIter *iter,
1746                                                         void *user_data)
1747 {
1748         if (key == NULL) {
1749                 callback_system_ready();
1750                 return;
1751         }
1752
1753         if (g_strcmp0(key, "DebugLevel") == 0) {
1754                 const char *str = NULL;
1755                 int i;
1756
1757                 dbus_message_iter_get_basic(iter, &str);
1758                 for (i = 0; debug_strings[i] != NULL; i++)
1759                         if (g_strcmp0(debug_strings[i], str) == 0) {
1760                                 debug_level = i;
1761                                 break;
1762                         }
1763                 SUPPLICANT_DBG("Debug level %d", debug_level);
1764         } else if (g_strcmp0(key, "DebugTimestamp") == 0) {
1765                 dbus_message_iter_get_basic(iter, &debug_timestamp);
1766                 SUPPLICANT_DBG("Debug timestamp %u", debug_timestamp);
1767         } else if (g_strcmp0(key, "DebugShowKeys") == 0) {
1768                 dbus_message_iter_get_basic(iter, &debug_showkeys);
1769                 SUPPLICANT_DBG("Debug show keys %u", debug_showkeys);
1770         } else if (g_strcmp0(key, "Interfaces") == 0) {
1771                 supplicant_dbus_array_foreach(iter, interface_added, NULL);
1772         } else if (g_strcmp0(key, "EapMethods") == 0) {
1773                 supplicant_dbus_array_foreach(iter, eap_method, NULL);
1774                 debug_strvalmap("EAP method", eap_method_map, eap_methods);
1775         } else if (g_strcmp0(key, "Country") == 0) {
1776                 const char *country = NULL;
1777
1778                 dbus_message_iter_get_basic(iter, &country);
1779                 SUPPLICANT_DBG("Country %s", country);
1780         } else
1781                 SUPPLICANT_DBG("key %s type %c",
1782                                 key, dbus_message_iter_get_arg_type(iter));
1783 }
1784
1785 static void signal_name_owner_changed(const char *path, DBusMessageIter *iter)
1786 {
1787         const char *name = NULL, *old = NULL, *new = NULL;
1788
1789         SUPPLICANT_DBG("");
1790
1791         if (g_strcmp0(path, DBUS_PATH_DBUS) != 0)
1792                 return;
1793
1794         dbus_message_iter_get_basic(iter, &name);
1795         if (name == NULL)
1796                 return;
1797
1798         if (g_strcmp0(name, SUPPLICANT_SERVICE) != 0)
1799                 return;
1800
1801         dbus_message_iter_next(iter);
1802         dbus_message_iter_get_basic(iter, &old);
1803         dbus_message_iter_next(iter);
1804         dbus_message_iter_get_basic(iter, &new);
1805
1806         if (old == NULL || new == NULL)
1807                 return;
1808
1809         if (strlen(old) > 0 && strlen(new) == 0) {
1810                 system_available = FALSE;
1811                 g_hash_table_remove_all(bss_mapping);
1812                 g_hash_table_remove_all(interface_table);
1813                 callback_system_killed();
1814         }
1815
1816         if (strlen(new) > 0 && strlen(old) == 0) {
1817                 system_available = TRUE;
1818                 supplicant_dbus_property_get_all(SUPPLICANT_PATH,
1819                                                         SUPPLICANT_INTERFACE,
1820                                                         service_property, NULL);
1821         }
1822 }
1823
1824 static void signal_properties_changed(const char *path, DBusMessageIter *iter)
1825 {
1826         SUPPLICANT_DBG("");
1827
1828         if (g_strcmp0(path, SUPPLICANT_PATH) != 0)
1829                 return;
1830
1831         supplicant_dbus_property_foreach(iter, service_property, NULL);
1832 }
1833
1834 static void signal_interface_added(const char *path, DBusMessageIter *iter)
1835 {
1836         SUPPLICANT_DBG("path %s %s", path, SUPPLICANT_PATH);
1837
1838         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
1839                 interface_added(iter, NULL);
1840 }
1841
1842 static void signal_interface_removed(const char *path, DBusMessageIter *iter)
1843 {
1844         SUPPLICANT_DBG("");
1845
1846         if (g_strcmp0(path, SUPPLICANT_PATH) == 0)
1847                 interface_removed(iter, NULL);
1848 }
1849
1850 static void signal_interface_changed(const char *path, DBusMessageIter *iter)
1851 {
1852         GSupplicantInterface *interface;
1853
1854         SUPPLICANT_DBG("");
1855
1856         interface = g_hash_table_lookup(interface_table, path);
1857         if (interface == NULL)
1858                 return;
1859
1860         supplicant_dbus_property_foreach(iter, interface_property, interface);
1861 }
1862
1863 static void signal_scan_done(const char *path, DBusMessageIter *iter)
1864 {
1865         GSupplicantInterface *interface;
1866         dbus_bool_t success = FALSE;
1867
1868         SUPPLICANT_DBG("");
1869
1870         interface = g_hash_table_lookup(interface_table, path);
1871         if (interface == NULL)
1872                 return;
1873
1874         dbus_message_iter_get_basic(iter, &success);
1875
1876         /*
1877          * If scan is unsuccessful return -EIO else get the scanned BSSs
1878          * and update the network details accordingly
1879          */
1880         if (success == FALSE) {
1881                 if (interface->scan_callback != NULL)
1882                         interface->scan_callback(-EIO, interface,
1883                                                 interface->scan_data);
1884
1885                 interface->scan_callback = NULL;
1886                 interface->scan_data = NULL;
1887
1888                 return;
1889         }
1890
1891         supplicant_dbus_property_get(path, SUPPLICANT_INTERFACE ".Interface",
1892                                         "BSSs", scan_bss_data, interface);
1893 }
1894
1895 static void signal_bss_added(const char *path, DBusMessageIter *iter)
1896 {
1897         GSupplicantInterface *interface;
1898
1899         SUPPLICANT_DBG("");
1900
1901         interface = g_hash_table_lookup(interface_table, path);
1902         if (interface == NULL)
1903                 return;
1904
1905         interface_bss_added_with_keys(iter, interface);
1906 }
1907
1908 static void signal_bss_removed(const char *path, DBusMessageIter *iter)
1909 {
1910         GSupplicantInterface *interface;
1911
1912         SUPPLICANT_DBG("");
1913
1914         interface = g_hash_table_lookup(interface_table, path);
1915         if (interface == NULL)
1916                 return;
1917
1918         interface_bss_removed(iter, interface);
1919 }
1920
1921 static void signal_network_added(const char *path, DBusMessageIter *iter)
1922 {
1923         GSupplicantInterface *interface;
1924
1925         SUPPLICANT_DBG("");
1926
1927         interface = g_hash_table_lookup(interface_table, path);
1928         if (interface == NULL)
1929                 return;
1930
1931         interface_network_added(iter, interface);
1932 }
1933
1934 static void signal_network_removed(const char *path, DBusMessageIter *iter)
1935 {
1936         GSupplicantInterface *interface;
1937
1938         SUPPLICANT_DBG("");
1939
1940         interface = g_hash_table_lookup(interface_table, path);
1941         if (interface == NULL)
1942                 return;
1943
1944         interface_network_removed(iter, interface);
1945 }
1946
1947 static void signal_bss_changed(const char *path, DBusMessageIter *iter)
1948 {
1949         GSupplicantInterface *interface;
1950         GSupplicantNetwork *network;
1951         struct g_supplicant_bss *bss;
1952
1953         SUPPLICANT_DBG("");
1954
1955         interface = g_hash_table_lookup(bss_mapping, path);
1956         if (interface == NULL)
1957                 return;
1958
1959         network = g_hash_table_lookup(interface->bss_mapping, path);
1960         if (network == NULL)
1961                 return;
1962
1963         bss = g_hash_table_lookup(network->bss_table, path);
1964         if (bss == NULL)
1965                 return;
1966
1967         supplicant_dbus_property_foreach(iter, bss_property, bss);
1968
1969         if (bss->signal == network->signal)
1970                 return;
1971
1972         /*
1973          * If the new signal is lower than the SSID signal, we need
1974          * to check for the new maximum.
1975          */
1976         if (bss->signal < network->signal) {
1977                 if (bss != network->best_bss)
1978                         return;
1979                 network->signal = bss->signal;
1980                 update_network_signal(network);
1981         } else {
1982                 network->signal = bss->signal;
1983                 network->best_bss = bss;
1984         }
1985
1986         SUPPLICANT_DBG("New network signal for %s %d dBm", network->ssid, network->signal);
1987
1988         callback_network_changed(network, "Signal");
1989 }
1990
1991 static void wps_credentials(const char *key, DBusMessageIter *iter,
1992                         void *user_data)
1993 {
1994         GSupplicantInterface *interface = user_data;
1995
1996         if (key == NULL)
1997                 return;
1998
1999         SUPPLICANT_DBG("key %s", key);
2000
2001         if (g_strcmp0(key, "Key") == 0) {
2002                 DBusMessageIter array;
2003                 unsigned char *key;
2004                 int key_len;
2005
2006                 dbus_message_iter_recurse(iter, &array);
2007                 dbus_message_iter_get_fixed_array(&array, &key, &key_len);
2008
2009                 g_free(interface->wps_cred.key);
2010                 interface->wps_cred.key = g_try_malloc0(
2011                                                 sizeof(char) * key_len+1);
2012
2013                 if (interface->wps_cred.key == NULL)
2014                         return;
2015
2016                 memcpy(interface->wps_cred.key, key, sizeof(char) * key_len);
2017
2018                 SUPPLICANT_DBG("WPS key present");
2019         } else if (g_strcmp0(key, "SSID") == 0) {
2020                 DBusMessageIter array;
2021                 unsigned char *ssid;
2022                 int ssid_len;
2023
2024                 dbus_message_iter_recurse(iter, &array);
2025                 dbus_message_iter_get_fixed_array(&array, &ssid, &ssid_len);
2026
2027                 if (ssid_len > 0 && ssid_len < 33) {
2028                         memcpy(interface->wps_cred.ssid, ssid, ssid_len);
2029                         interface->wps_cred.ssid_len = ssid_len;
2030                 } else {
2031                         memset(interface->wps_cred.ssid, 0, 32);
2032                         interface->wps_cred.ssid_len = 0;
2033                 }
2034         }
2035 }
2036
2037 static void signal_wps_credentials(const char *path, DBusMessageIter *iter)
2038 {
2039         GSupplicantInterface *interface;
2040
2041         SUPPLICANT_DBG("");
2042
2043         interface = g_hash_table_lookup(interface_table, path);
2044         if (interface == NULL)
2045                 return;
2046
2047         supplicant_dbus_property_foreach(iter, wps_credentials, interface);
2048 }
2049
2050 static void wps_event_args(const char *key, DBusMessageIter *iter,
2051                         void *user_data)
2052 {
2053         GSupplicantInterface *interface = user_data;
2054
2055         if (key == NULL || interface == NULL)
2056                 return;
2057
2058         SUPPLICANT_DBG("Arg Key %s", key);
2059 }
2060
2061 static void signal_wps_event(const char *path, DBusMessageIter *iter)
2062 {
2063         GSupplicantInterface *interface;
2064         const char *name = NULL;
2065
2066         SUPPLICANT_DBG("");
2067
2068         interface = g_hash_table_lookup(interface_table, path);
2069         if (interface == NULL)
2070                 return;
2071
2072         dbus_message_iter_get_basic(iter, &name);
2073
2074         SUPPLICANT_DBG("Name: %s", name);
2075
2076         if (g_strcmp0(name, "success") == 0)
2077                 interface->wps_state = G_SUPPLICANT_WPS_STATE_SUCCESS;
2078         else if (g_strcmp0(name, "failed") == 0)
2079                 interface->wps_state = G_SUPPLICANT_WPS_STATE_FAIL;
2080         else
2081                 interface->wps_state = G_SUPPLICANT_WPS_STATE_UNKNOWN;
2082
2083         if (!dbus_message_iter_has_next(iter))
2084                 return;
2085
2086         dbus_message_iter_next(iter);
2087
2088         supplicant_dbus_property_foreach(iter, wps_event_args, interface);
2089 }
2090
2091 static struct {
2092         const char *interface;
2093         const char *member;
2094         void (*function) (const char *path, DBusMessageIter *iter);
2095 } signal_map[] = {
2096         { DBUS_INTERFACE_DBUS,  "NameOwnerChanged",  signal_name_owner_changed },
2097
2098         { SUPPLICANT_INTERFACE, "PropertiesChanged", signal_properties_changed },
2099         { SUPPLICANT_INTERFACE, "InterfaceAdded",    signal_interface_added    },
2100         { SUPPLICANT_INTERFACE, "InterfaceCreated",  signal_interface_added    },
2101         { SUPPLICANT_INTERFACE, "InterfaceRemoved",  signal_interface_removed  },
2102
2103         { SUPPLICANT_INTERFACE ".Interface", "PropertiesChanged", signal_interface_changed },
2104         { SUPPLICANT_INTERFACE ".Interface", "ScanDone",          signal_scan_done         },
2105         { SUPPLICANT_INTERFACE ".Interface", "BSSAdded",          signal_bss_added         },
2106         { SUPPLICANT_INTERFACE ".Interface", "BSSRemoved",        signal_bss_removed       },
2107         { SUPPLICANT_INTERFACE ".Interface", "NetworkAdded",      signal_network_added     },
2108         { SUPPLICANT_INTERFACE ".Interface", "NetworkRemoved",    signal_network_removed   },
2109
2110         { SUPPLICANT_INTERFACE ".BSS", "PropertiesChanged", signal_bss_changed   },
2111
2112         { SUPPLICANT_INTERFACE ".Interface.WPS", "Credentials", signal_wps_credentials },
2113         { SUPPLICANT_INTERFACE ".Interface.WPS", "Event",       signal_wps_event       },
2114
2115         { }
2116 };
2117
2118 static DBusHandlerResult g_supplicant_filter(DBusConnection *conn,
2119                                         DBusMessage *message, void *data)
2120 {
2121         DBusMessageIter iter;
2122         const char *path;
2123         int i;
2124
2125         path = dbus_message_get_path(message);
2126         if (path == NULL)
2127                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
2128
2129         if (dbus_message_iter_init(message, &iter) == FALSE)
2130                 return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
2131
2132         for (i = 0; signal_map[i].interface != NULL; i++) {
2133                 if (dbus_message_has_interface(message,
2134                                         signal_map[i].interface) == FALSE)
2135                         continue;
2136
2137                 if (dbus_message_has_member(message,
2138                                         signal_map[i].member) == FALSE)
2139                         continue;
2140
2141                 signal_map[i].function(path, &iter);
2142                 break;
2143         }
2144
2145         return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
2146 }
2147
2148 struct supplicant_regdom {
2149         GSupplicantCountryCallback callback;
2150         const void *user_data;
2151 };
2152
2153 static void country_result(const char *error,
2154                                 DBusMessageIter *iter, void *user_data)
2155 {
2156         struct supplicant_regdom *regdom = user_data;
2157         char *alpha2;
2158
2159         SUPPLICANT_DBG("Country setting result");
2160
2161         if (user_data == NULL)
2162                 return;
2163
2164         if (error == NULL) {
2165                 alpha2 = (char *)regdom->user_data;
2166         } else {
2167                 SUPPLICANT_DBG("Country setting failure %s", error);
2168                 alpha2 = NULL;
2169         }
2170
2171         if (regdom->callback)
2172                 regdom->callback(alpha2);
2173
2174         g_free(regdom);
2175 }
2176
2177 static void country_params(DBusMessageIter *iter, void *user_data)
2178 {
2179         struct supplicant_regdom *regdom = user_data;
2180         const char *country;
2181
2182         country = regdom->user_data;
2183
2184         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &country);
2185 }
2186
2187 int g_supplicant_set_country(const char *alpha2,
2188                                 GSupplicantCountryCallback callback,
2189                                         const void *user_data)
2190 {
2191         struct supplicant_regdom *regdom;
2192
2193         SUPPLICANT_DBG("Country setting %s", alpha2);
2194
2195         if (system_available == FALSE)
2196                 return -EFAULT;
2197
2198         regdom = dbus_malloc0(sizeof(*regdom));
2199         if (regdom == NULL)
2200                 return -ENOMEM;
2201
2202         regdom->callback = callback;
2203         regdom->user_data = user_data;
2204
2205         return supplicant_dbus_property_set(SUPPLICANT_PATH, SUPPLICANT_INTERFACE,
2206                                         "Country", DBUS_TYPE_STRING_AS_STRING,
2207                                         country_params, country_result,
2208                                                 regdom);
2209 }
2210
2211 struct interface_data {
2212         GSupplicantInterface *interface;
2213         GSupplicantInterfaceCallback callback;
2214         void *user_data;
2215 };
2216
2217 struct interface_create_data {
2218         const char *ifname;
2219         const char *driver;
2220         const char *bridge;
2221         GSupplicantInterface *interface;
2222         GSupplicantInterfaceCallback callback;
2223         void *user_data;
2224 };
2225
2226 struct interface_connect_data {
2227         GSupplicantInterface *interface;
2228         GSupplicantInterfaceCallback callback;
2229         GSupplicantSSID *ssid;
2230         void *user_data;
2231 };
2232
2233 struct interface_scan_data {
2234         GSupplicantInterface *interface;
2235         GSupplicantInterfaceCallback callback;
2236         GSupplicantScanParams *scan_params;
2237         void *user_data;
2238 };
2239
2240 static void interface_create_property(const char *key, DBusMessageIter *iter,
2241                                                         void *user_data)
2242 {
2243         struct interface_create_data *data = user_data;
2244         GSupplicantInterface *interface = data->interface;
2245
2246         if (key == NULL) {
2247                 if (data->callback != NULL)
2248                         data->callback(0, data->interface, data->user_data);
2249
2250                 dbus_free(data);
2251         }
2252
2253         interface_property(key, iter, interface);
2254 }
2255
2256 static void interface_create_result(const char *error,
2257                                 DBusMessageIter *iter, void *user_data)
2258 {
2259         struct interface_create_data *data = user_data;
2260         const char *path = NULL;
2261         int err;
2262
2263         SUPPLICANT_DBG("");
2264
2265         if (error != NULL) {
2266                 g_critical("error %s", error);
2267                 err = -EIO;
2268                 goto done;
2269         }
2270
2271         dbus_message_iter_get_basic(iter, &path);
2272         if (path == NULL) {
2273                 err = -EINVAL;
2274                 goto done;
2275         }
2276
2277         if (system_available == FALSE) {
2278                 err = -EFAULT;
2279                 goto done;
2280         }
2281
2282         data->interface = g_hash_table_lookup(interface_table, path);
2283         if (data->interface == NULL) {
2284                 data->interface = interface_alloc(path);
2285                 if (data->interface == NULL) {
2286                         err = -ENOMEM;
2287                         goto done;
2288                 }
2289         }
2290
2291         err = supplicant_dbus_property_get_all(path,
2292                                         SUPPLICANT_INTERFACE ".Interface",
2293                                         interface_create_property, data);
2294         if (err == 0)
2295                 return;
2296
2297 done:
2298         if (data->callback != NULL)
2299                 data->callback(err, NULL, data->user_data);
2300
2301         dbus_free(data);
2302 }
2303
2304 static void interface_create_params(DBusMessageIter *iter, void *user_data)
2305 {
2306         struct interface_create_data *data = user_data;
2307         DBusMessageIter dict;
2308
2309         SUPPLICANT_DBG("");
2310
2311         supplicant_dbus_dict_open(iter, &dict);
2312
2313         supplicant_dbus_dict_append_basic(&dict, "Ifname",
2314                                         DBUS_TYPE_STRING, &data->ifname);
2315
2316         if (data->driver != NULL)
2317                 supplicant_dbus_dict_append_basic(&dict, "Driver",
2318                                         DBUS_TYPE_STRING, &data->driver);
2319
2320         if (data->bridge != NULL)
2321                 supplicant_dbus_dict_append_basic(&dict, "BridgeIfname",
2322                                         DBUS_TYPE_STRING, &data->bridge);
2323
2324         supplicant_dbus_dict_close(iter, &dict);
2325 }
2326
2327 static void interface_get_result(const char *error,
2328                                 DBusMessageIter *iter, void *user_data)
2329 {
2330         struct interface_create_data *data = user_data;
2331         GSupplicantInterface *interface;
2332         const char *path = NULL;
2333         int err;
2334
2335         SUPPLICANT_DBG("");
2336
2337         if (error != NULL) {
2338                 SUPPLICANT_DBG("Interface not created yet");
2339                 err = -EIO;
2340                 goto create;
2341         }
2342
2343         dbus_message_iter_get_basic(iter, &path);
2344         if (path == NULL) {
2345                 err = -EINVAL;
2346                 goto done;
2347         }
2348
2349         interface = g_hash_table_lookup(interface_table, path);
2350         if (interface == NULL) {
2351                 err = -ENOENT;
2352                 goto done;
2353         }
2354
2355         if (data->callback != NULL)
2356                 data->callback(0, interface, data->user_data);
2357
2358         dbus_free(data);
2359
2360         return;
2361
2362 create:
2363         if (system_available == FALSE) {
2364                 err = -EFAULT;
2365                 goto done;
2366         }
2367
2368         SUPPLICANT_DBG("Creating interface");
2369
2370         err = supplicant_dbus_method_call(SUPPLICANT_PATH,
2371                                                 SUPPLICANT_INTERFACE,
2372                                                 "CreateInterface",
2373                                                 interface_create_params,
2374                                                 interface_create_result, data);
2375         if (err == 0)
2376                 return;
2377
2378 done:
2379         if (data->callback != NULL)
2380                 data->callback(err, NULL, data->user_data);
2381
2382         dbus_free(data);
2383 }
2384
2385 static void interface_get_params(DBusMessageIter *iter, void *user_data)
2386 {
2387         struct interface_create_data *data = user_data;
2388
2389         SUPPLICANT_DBG("");
2390
2391         dbus_message_iter_append_basic(iter, DBUS_TYPE_STRING, &data->ifname);
2392 }
2393
2394 int g_supplicant_interface_create(const char *ifname, const char *driver,
2395                                         const char *bridge,
2396                                         GSupplicantInterfaceCallback callback,
2397                                                         void *user_data)
2398 {
2399         struct interface_create_data *data;
2400
2401         SUPPLICANT_DBG("ifname %s", ifname);
2402
2403         if (ifname == NULL)
2404                 return -EINVAL;
2405
2406         if (system_available == FALSE)
2407                 return -EFAULT;
2408
2409         data = dbus_malloc0(sizeof(*data));
2410         if (data == NULL)
2411                 return -ENOMEM;
2412
2413         data->ifname = ifname;
2414         data->driver = driver;
2415         data->bridge = bridge;
2416         data->callback = callback;
2417         data->user_data = user_data;
2418
2419         return supplicant_dbus_method_call(SUPPLICANT_PATH,
2420                                                 SUPPLICANT_INTERFACE,
2421                                                 "GetInterface",
2422                                                 interface_get_params,
2423                                                 interface_get_result, data);
2424 }
2425
2426 static void interface_remove_result(const char *error,
2427                                 DBusMessageIter *iter, void *user_data)
2428 {
2429         struct interface_data *data = user_data;
2430         int err;
2431
2432         if (error != NULL) {
2433                 err = -EIO;
2434                 goto done;
2435         }
2436
2437         if (system_available == FALSE) {
2438                 err = -EFAULT;
2439                 goto done;
2440         }
2441
2442         /*
2443          * The gsupplicant interface is already freed by the InterfaceRemoved
2444          * signal callback. Simply invoke the interface_data callback.
2445          */
2446         err = 0;
2447
2448 done:
2449         if (data->callback != NULL)
2450                 data->callback(err, NULL, data->user_data);
2451
2452         dbus_free(data);
2453 }
2454
2455
2456 static void interface_remove_params(DBusMessageIter *iter, void *user_data)
2457 {
2458         struct interface_data *data = user_data;
2459
2460         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
2461                                                         &data->interface->path);
2462 }
2463
2464
2465 int g_supplicant_interface_remove(GSupplicantInterface *interface,
2466                         GSupplicantInterfaceCallback callback,
2467                                                         void *user_data)
2468 {
2469         struct interface_data *data;
2470
2471         if (interface == NULL)
2472                 return -EINVAL;
2473
2474         if (system_available == FALSE)
2475                 return -EFAULT;
2476
2477         data = dbus_malloc0(sizeof(*data));
2478         if (data == NULL)
2479                 return -ENOMEM;
2480
2481         data->interface = interface;
2482         data->callback = callback;
2483         data->user_data = user_data;
2484
2485         return supplicant_dbus_method_call(SUPPLICANT_PATH,
2486                                                 SUPPLICANT_INTERFACE,
2487                                                 "RemoveInterface",
2488                                                 interface_remove_params,
2489                                                 interface_remove_result, data);
2490 }
2491
2492 static void interface_scan_result(const char *error,
2493                                 DBusMessageIter *iter, void *user_data)
2494 {
2495         struct interface_scan_data *data = user_data;
2496
2497         if (error != NULL) {
2498                 SUPPLICANT_DBG("error %s", error);
2499
2500                 if (data->callback != NULL)
2501                         data->callback(-EIO, data->interface, data->user_data);
2502         } else {
2503                 data->interface->scan_callback = data->callback;
2504                 data->interface->scan_data = data->user_data;
2505         }
2506
2507         if (data != NULL && data->scan_params != NULL)
2508                 g_free(data->scan_params);
2509
2510         dbus_free(data);
2511 }
2512
2513 static void add_scan_frequency(DBusMessageIter *iter, unsigned int freq)
2514 {
2515         DBusMessageIter data;
2516         unsigned int width = 0; /* Not used by wpa_supplicant atm */
2517
2518         dbus_message_iter_open_container(iter, DBUS_TYPE_STRUCT, NULL, &data);
2519
2520         dbus_message_iter_append_basic(&data, DBUS_TYPE_UINT32, &freq);
2521         dbus_message_iter_append_basic(&data, DBUS_TYPE_UINT32, &width);
2522
2523         dbus_message_iter_close_container(iter, &data);
2524 }
2525
2526 static void add_scan_frequencies(DBusMessageIter *iter,
2527                                                 void *user_data)
2528 {
2529         GSupplicantScanParams *scan_data = user_data;
2530         unsigned int freq;
2531         int i;
2532
2533         for (i = 0; i < G_SUPPLICANT_MAX_FAST_SCAN; i++) {
2534                 freq = scan_data->freqs[i];
2535                 if (!freq)
2536                         break;
2537
2538                 add_scan_frequency(iter, freq);
2539         }
2540 }
2541
2542 static void append_ssid(DBusMessageIter *iter,
2543                         const void *ssid, unsigned int len)
2544 {
2545         DBusMessageIter array;
2546
2547         dbus_message_iter_open_container(iter, DBUS_TYPE_ARRAY,
2548         DBUS_TYPE_BYTE_AS_STRING, &array);
2549
2550         dbus_message_iter_append_fixed_array(&array, DBUS_TYPE_BYTE,
2551                                                                 &ssid, len);
2552         dbus_message_iter_close_container(iter, &array);
2553 }
2554
2555 static void append_ssids(DBusMessageIter *iter, void *user_data)
2556 {
2557         GSupplicantScanParams *scan_data = user_data;
2558         int i;
2559
2560         for (i = 0; i < scan_data->num_ssids; i++)
2561                 append_ssid(iter, scan_data->ssids[i].ssid,
2562                                         scan_data->ssids[i].ssid_len);
2563 }
2564
2565 static void supplicant_add_scan_frequency(DBusMessageIter *dict,
2566                 supplicant_dbus_array_function function,
2567                                         void *user_data)
2568 {
2569         GSupplicantScanParams *scan_params = user_data;
2570         DBusMessageIter entry, value, array;
2571         const char *key = "Channels";
2572
2573         if (scan_params->freqs[0] != 0) {
2574                 dbus_message_iter_open_container(dict, DBUS_TYPE_DICT_ENTRY,
2575                                                 NULL, &entry);
2576
2577                 dbus_message_iter_append_basic(&entry, DBUS_TYPE_STRING, &key);
2578
2579                 dbus_message_iter_open_container(&entry, DBUS_TYPE_VARIANT,
2580                                         DBUS_TYPE_ARRAY_AS_STRING
2581                                         DBUS_STRUCT_BEGIN_CHAR_AS_STRING
2582                                         DBUS_TYPE_UINT32_AS_STRING
2583                                         DBUS_TYPE_UINT32_AS_STRING
2584                                         DBUS_STRUCT_END_CHAR_AS_STRING,
2585                                         &value);
2586
2587                 dbus_message_iter_open_container(&value, DBUS_TYPE_ARRAY,
2588                                         DBUS_STRUCT_BEGIN_CHAR_AS_STRING
2589                                         DBUS_TYPE_UINT32_AS_STRING
2590                                         DBUS_TYPE_UINT32_AS_STRING
2591                                         DBUS_STRUCT_END_CHAR_AS_STRING,
2592                                         &array);
2593
2594                 if (function)
2595                         function(&array, user_data);
2596
2597                 dbus_message_iter_close_container(&value, &array);
2598                 dbus_message_iter_close_container(&entry, &value);
2599                 dbus_message_iter_close_container(dict, &entry);
2600         }
2601 }
2602
2603 static void interface_scan_params(DBusMessageIter *iter, void *user_data)
2604 {
2605         DBusMessageIter dict;
2606         const char *type = "passive";
2607         struct interface_scan_data *data = user_data;
2608
2609         supplicant_dbus_dict_open(iter, &dict);
2610
2611         if (data && data->scan_params) {
2612                 type = "active";
2613
2614                 supplicant_dbus_dict_append_basic(&dict, "Type",
2615                                         DBUS_TYPE_STRING, &type);
2616
2617                 supplicant_dbus_dict_append_array(&dict, "SSIDs",
2618                                                 DBUS_TYPE_STRING,
2619                                                 append_ssids,
2620                                                 data->scan_params);
2621
2622                 supplicant_add_scan_frequency(&dict, add_scan_frequencies,
2623                                                 data->scan_params);
2624         } else
2625                 supplicant_dbus_dict_append_basic(&dict, "Type",
2626                                         DBUS_TYPE_STRING, &type);
2627
2628         supplicant_dbus_dict_close(iter, &dict);
2629 }
2630
2631 int g_supplicant_interface_scan(GSupplicantInterface *interface,
2632                                 GSupplicantScanParams *scan_data,
2633                                 GSupplicantInterfaceCallback callback,
2634                                                         void *user_data)
2635 {
2636         struct interface_scan_data *data;
2637         int ret;
2638
2639         if (interface == NULL)
2640                 return -EINVAL;
2641
2642         if (system_available == FALSE)
2643                 return -EFAULT;
2644
2645         if (interface->scanning == TRUE)
2646                 return -EALREADY;
2647
2648         switch (interface->state) {
2649         case G_SUPPLICANT_STATE_AUTHENTICATING:
2650         case G_SUPPLICANT_STATE_ASSOCIATING:
2651         case G_SUPPLICANT_STATE_ASSOCIATED:
2652         case G_SUPPLICANT_STATE_4WAY_HANDSHAKE:
2653         case G_SUPPLICANT_STATE_GROUP_HANDSHAKE:
2654                 return -EBUSY;
2655         case G_SUPPLICANT_STATE_UNKNOWN:
2656         case G_SUPPLICANT_STATE_DISCONNECTED:
2657         case G_SUPPLICANT_STATE_INACTIVE:
2658         case G_SUPPLICANT_STATE_SCANNING:
2659         case G_SUPPLICANT_STATE_COMPLETED:
2660                 break;
2661         }
2662
2663         data = dbus_malloc0(sizeof(*data));
2664         if (data == NULL)
2665                 return -ENOMEM;
2666
2667         data->interface = interface;
2668         data->callback = callback;
2669         data->user_data = user_data;
2670         data->scan_params = scan_data;
2671
2672         ret = supplicant_dbus_method_call(interface->path,
2673                         SUPPLICANT_INTERFACE ".Interface", "Scan",
2674                         interface_scan_params, interface_scan_result, data);
2675
2676         if (ret < 0)
2677                 dbus_free(data);
2678
2679         return ret;
2680 }
2681
2682 static int parse_supplicant_error(DBusMessageIter *iter)
2683 {
2684         int err = -ECANCELED;
2685         char *key;
2686
2687         while (dbus_message_iter_get_arg_type(iter) == DBUS_TYPE_STRING) {
2688                 dbus_message_iter_get_basic(iter, &key);
2689                 if (strncmp(key, "psk", 4) == 0 ||
2690                         strncmp(key, "wep_key", 7) == 0) {
2691                         err = -ENOKEY;
2692                         break;
2693                 }
2694                 dbus_message_iter_next(iter);
2695         }
2696
2697         return err;
2698 }
2699
2700 static void interface_select_network_result(const char *error,
2701                                 DBusMessageIter *iter, void *user_data)
2702 {
2703         struct interface_connect_data *data = user_data;
2704         int err;
2705
2706         SUPPLICANT_DBG("");
2707
2708         err = 0;
2709         if (error != NULL) {
2710                 SUPPLICANT_DBG("SelectNetwork error %s", error);
2711                 err = parse_supplicant_error(iter);
2712         }
2713
2714         if (data->callback != NULL)
2715                 data->callback(err, data->interface, data->user_data);
2716
2717         g_free(data->ssid);
2718         dbus_free(data);
2719 }
2720
2721 static void interface_select_network_params(DBusMessageIter *iter,
2722                                                         void *user_data)
2723 {
2724         struct interface_connect_data *data = user_data;
2725         GSupplicantInterface *interface = data->interface;
2726
2727         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
2728                                         &interface->network_path);
2729 }
2730
2731 static void interface_add_network_result(const char *error,
2732                                 DBusMessageIter *iter, void *user_data)
2733 {
2734         struct interface_connect_data *data = user_data;
2735         GSupplicantInterface *interface = data->interface;
2736         const char *path;
2737         int err;
2738
2739         if (error != NULL)
2740                 goto error;
2741
2742         dbus_message_iter_get_basic(iter, &path);
2743         if (path == NULL)
2744                 goto error;
2745
2746         SUPPLICANT_DBG("PATH: %s", path);
2747
2748         g_free(interface->network_path);
2749         interface->network_path = g_strdup(path);
2750
2751         supplicant_dbus_method_call(data->interface->path,
2752                         SUPPLICANT_INTERFACE ".Interface", "SelectNetwork",
2753                         interface_select_network_params,
2754                         interface_select_network_result, data);
2755
2756         return;
2757
2758 error:
2759         SUPPLICANT_DBG("AddNetwork error %s", error);
2760         err = parse_supplicant_error(iter);
2761         if (data->callback != NULL)
2762                 data->callback(err, data->interface, data->user_data);
2763
2764         g_free(interface->network_path);
2765         interface->network_path = NULL;
2766         g_free(data->ssid);
2767         g_free(data);
2768 }
2769
2770 static void add_network_security_wep(DBusMessageIter *dict,
2771                                         GSupplicantSSID *ssid)
2772 {
2773         const char *auth_alg = "OPEN SHARED";
2774         const char *key_index = "0";
2775
2776         supplicant_dbus_dict_append_basic(dict, "auth_alg",
2777                                         DBUS_TYPE_STRING, &auth_alg);
2778
2779         if (ssid->passphrase) {
2780                 int size = strlen(ssid->passphrase);
2781                 if (size == 10 || size == 26) {
2782                         unsigned char *key = g_try_malloc(13);
2783                         char tmp[3];
2784                         int i;
2785
2786                         memset(tmp, 0, sizeof(tmp));
2787                         if (key == NULL)
2788                                 size = 0;
2789
2790                         for (i = 0; i < size / 2; i++) {
2791                                 memcpy(tmp, ssid->passphrase + (i * 2), 2);
2792                                 key[i] = (unsigned char) strtol(tmp, NULL, 16);
2793                         }
2794
2795                         supplicant_dbus_dict_append_fixed_array(dict,
2796                                                         "wep_key0",
2797                                                         DBUS_TYPE_BYTE,
2798                                                         &key, size / 2);
2799                         g_free(key);
2800                 } else if (size == 5 || size == 13) {
2801                         unsigned char *key = g_try_malloc(13);
2802                         int i;
2803
2804                         if (key == NULL)
2805                                 size = 0;
2806
2807                         for (i = 0; i < size; i++)
2808                                 key[i] = (unsigned char) ssid->passphrase[i];
2809
2810                         supplicant_dbus_dict_append_fixed_array(dict,
2811                                                                 "wep_key0",
2812                                                                 DBUS_TYPE_BYTE,
2813                                                                 &key, size);
2814                         g_free(key);
2815                 } else
2816                         supplicant_dbus_dict_append_basic(dict,
2817                                                         "wep_key0",
2818                                                         DBUS_TYPE_STRING,
2819                                                         &ssid->passphrase);
2820
2821                 supplicant_dbus_dict_append_basic(dict, "wep_tx_keyidx",
2822                                         DBUS_TYPE_STRING, &key_index);
2823         }
2824 }
2825
2826 static dbus_bool_t is_psk_raw_key(const char *psk)
2827 {
2828         int i;
2829
2830         /* A raw key is always 64 bytes length... */
2831         if (strlen(psk) != 64)
2832                 return FALSE;
2833
2834         /* ... and its content is in hex representation */
2835         for (i = 0; i < 64; i++)
2836                 if (!isxdigit((unsigned char) psk[i]))
2837                         return FALSE;
2838
2839         return TRUE;
2840 }
2841
2842 static void add_network_security_psk(DBusMessageIter *dict,
2843                                         GSupplicantSSID *ssid)
2844 {
2845         if (ssid->passphrase && strlen(ssid->passphrase) > 0) {
2846
2847                 if (is_psk_raw_key(ssid->passphrase) == TRUE)
2848                         supplicant_dbus_property_append_fixed_array(dict,
2849                                                         "psk", DBUS_TYPE_BYTE,
2850                                                         &ssid->passphrase, 64);
2851                 else
2852                         supplicant_dbus_dict_append_basic(dict, "psk",
2853                                                         DBUS_TYPE_STRING,
2854                                                         &ssid->passphrase);
2855         }
2856 }
2857
2858 static void add_network_security_tls(DBusMessageIter *dict,
2859                                         GSupplicantSSID *ssid)
2860 {
2861         /*
2862          * For TLS, we at least need:
2863          *              The client certificate
2864          *              The client private key file
2865          *              The client private key file password
2866          *
2867          * The Authority certificate is optional.
2868          */
2869         if (ssid->client_cert_path == NULL)
2870                 return;
2871
2872         if (ssid->private_key_path == NULL)
2873                 return;
2874
2875         if (ssid->private_key_passphrase == NULL)
2876                 return;
2877
2878         if (ssid->ca_cert_path)
2879                 supplicant_dbus_dict_append_basic(dict, "ca_cert",
2880                                         DBUS_TYPE_STRING, &ssid->ca_cert_path);
2881
2882         supplicant_dbus_dict_append_basic(dict, "private_key",
2883                                                 DBUS_TYPE_STRING,
2884                                                 &ssid->private_key_path);
2885         supplicant_dbus_dict_append_basic(dict, "private_key_passwd",
2886                                                 DBUS_TYPE_STRING,
2887                                                 &ssid->private_key_passphrase);
2888         supplicant_dbus_dict_append_basic(dict, "client_cert",
2889                                                 DBUS_TYPE_STRING,
2890                                                 &ssid->client_cert_path);
2891 }
2892
2893 static void add_network_security_peap(DBusMessageIter *dict,
2894                                         GSupplicantSSID *ssid)
2895 {
2896         char *phase2_auth;
2897
2898         /*
2899          * For PEAP/TTLS, we at least need
2900          *              The authority certificate
2901          *              The 2nd phase authentication method
2902          *              The 2nd phase passphrase
2903          *
2904          * The Client certificate is optional although strongly recommended
2905          * When setting it, we need in addition
2906          *              The Client private key file
2907          *              The Client private key file password
2908          */
2909         if (ssid->passphrase == NULL)
2910                 return;
2911
2912         if (ssid->phase2_auth == NULL)
2913                 return;
2914
2915         if (ssid->client_cert_path) {
2916                 if (ssid->private_key_path == NULL)
2917                         return;
2918
2919                 if (ssid->private_key_passphrase == NULL)
2920                         return;
2921
2922                 supplicant_dbus_dict_append_basic(dict, "client_cert",
2923                                                 DBUS_TYPE_STRING,
2924                                                 &ssid->client_cert_path);
2925
2926                 supplicant_dbus_dict_append_basic(dict, "private_key",
2927                                                 DBUS_TYPE_STRING,
2928                                                 &ssid->private_key_path);
2929
2930                 supplicant_dbus_dict_append_basic(dict, "private_key_passwd",
2931                                                 DBUS_TYPE_STRING,
2932                                                 &ssid->private_key_passphrase);
2933
2934         }
2935
2936         if (g_str_has_prefix(ssid->phase2_auth, "EAP-") == TRUE) {
2937                 phase2_auth = g_strdup_printf("autheap=%s",
2938                                         ssid->phase2_auth + strlen("EAP-"));
2939         } else
2940                 phase2_auth = g_strdup_printf("auth=%s", ssid->phase2_auth);
2941
2942         supplicant_dbus_dict_append_basic(dict, "password",
2943                                                 DBUS_TYPE_STRING,
2944                                                 &ssid->passphrase);
2945
2946         if (ssid->ca_cert_path)
2947                 supplicant_dbus_dict_append_basic(dict, "ca_cert",
2948                                                 DBUS_TYPE_STRING,
2949                                                 &ssid->ca_cert_path);
2950
2951         supplicant_dbus_dict_append_basic(dict, "phase2",
2952                                                 DBUS_TYPE_STRING,
2953                                                 &phase2_auth);
2954
2955         g_free(phase2_auth);
2956 }
2957
2958 static void add_network_security_eap(DBusMessageIter *dict,
2959                                         GSupplicantSSID *ssid)
2960 {
2961         char *eap_value;
2962
2963         if (ssid->eap == NULL || ssid->identity == NULL)
2964                 return;
2965
2966         if (g_strcmp0(ssid->eap, "tls") == 0) {
2967                 add_network_security_tls(dict, ssid);
2968         } else if (g_strcmp0(ssid->eap, "peap") == 0 ||
2969                                 g_strcmp0(ssid->eap, "ttls") == 0) {
2970                 add_network_security_peap(dict, ssid);
2971         } else
2972                 return;
2973
2974         eap_value = g_ascii_strup(ssid->eap, -1);
2975
2976         supplicant_dbus_dict_append_basic(dict, "eap",
2977                                                 DBUS_TYPE_STRING,
2978                                                 &eap_value);
2979         supplicant_dbus_dict_append_basic(dict, "identity",
2980                                                 DBUS_TYPE_STRING,
2981                                                 &ssid->identity);
2982
2983         g_free(eap_value);
2984 }
2985
2986 static void add_network_security_ciphers(DBusMessageIter *dict,
2987                                                 GSupplicantSSID *ssid)
2988 {
2989         unsigned int p_cipher, g_cipher, i;
2990         char *pairwise, *group;
2991         char *pair_ciphers[4];
2992         char *group_ciphers[5];
2993
2994         p_cipher = ssid->pairwise_cipher;
2995         g_cipher = ssid->group_cipher;
2996
2997         if (p_cipher == 0 && g_cipher == 0)
2998                 return;
2999
3000         i = 0;
3001
3002         if (p_cipher & G_SUPPLICANT_PAIRWISE_CCMP)
3003                 pair_ciphers[i++] = "CCMP";
3004
3005         if (p_cipher & G_SUPPLICANT_PAIRWISE_TKIP)
3006                 pair_ciphers[i++] = "TKIP";
3007
3008         if (p_cipher & G_SUPPLICANT_PAIRWISE_NONE)
3009                 pair_ciphers[i++] = "NONE";
3010
3011         pair_ciphers[i] = NULL;
3012
3013         i = 0;
3014
3015         if (g_cipher & G_SUPPLICANT_GROUP_CCMP)
3016                 group_ciphers[i++] = "CCMP";
3017
3018         if (g_cipher & G_SUPPLICANT_GROUP_TKIP)
3019                 group_ciphers[i++] = "TKIP";
3020
3021         if (g_cipher & G_SUPPLICANT_GROUP_WEP104)
3022                 group_ciphers[i++] = "WEP104";
3023
3024         if (g_cipher & G_SUPPLICANT_GROUP_WEP40)
3025                 group_ciphers[i++] = "WEP40";
3026
3027         group_ciphers[i] = NULL;
3028
3029         pairwise = g_strjoinv(" ", pair_ciphers);
3030         group = g_strjoinv(" ", group_ciphers);
3031
3032         SUPPLICANT_DBG("cipher %s %s", pairwise, group);
3033
3034         supplicant_dbus_dict_append_basic(dict, "pairwise",
3035                                                 DBUS_TYPE_STRING,
3036                                                 &pairwise);
3037         supplicant_dbus_dict_append_basic(dict, "group",
3038                                                 DBUS_TYPE_STRING,
3039                                                 &group);
3040
3041         g_free(pairwise);
3042         g_free(group);
3043 }
3044
3045 static void add_network_security_proto(DBusMessageIter *dict,
3046                                                 GSupplicantSSID *ssid)
3047 {
3048         unsigned int protocol, i;
3049         char *proto;
3050         char *protos[3];
3051
3052         protocol = ssid->protocol;
3053
3054         if (protocol == 0)
3055                 return;
3056
3057         i = 0;
3058
3059         if (protocol & G_SUPPLICANT_PROTO_RSN)
3060                 protos[i++] = "RSN";
3061
3062         if (protocol & G_SUPPLICANT_PROTO_WPA)
3063                 protos[i++] = "WPA";
3064
3065         protos[i] = NULL;
3066
3067         proto = g_strjoinv(" ", protos);
3068
3069         SUPPLICANT_DBG("proto %s", proto);
3070
3071         supplicant_dbus_dict_append_basic(dict, "proto",
3072                                                 DBUS_TYPE_STRING,
3073                                                 &proto);
3074
3075         g_free(proto);
3076 }
3077
3078 static void add_network_security(DBusMessageIter *dict, GSupplicantSSID *ssid)
3079 {
3080         char *key_mgmt;
3081
3082         switch (ssid->security) {
3083         case G_SUPPLICANT_SECURITY_UNKNOWN:
3084         case G_SUPPLICANT_SECURITY_NONE:
3085         case G_SUPPLICANT_SECURITY_WEP:
3086                 key_mgmt = "NONE";
3087                 add_network_security_wep(dict, ssid);
3088                 add_network_security_ciphers(dict, ssid);
3089                 break;
3090         case G_SUPPLICANT_SECURITY_PSK:
3091                 key_mgmt = "WPA-PSK";
3092                 add_network_security_psk(dict, ssid);
3093                 add_network_security_ciphers(dict, ssid);
3094                 add_network_security_proto(dict, ssid);
3095                 break;
3096         case G_SUPPLICANT_SECURITY_IEEE8021X:
3097                 key_mgmt = "WPA-EAP";
3098                 add_network_security_eap(dict, ssid);
3099                 add_network_security_ciphers(dict, ssid);
3100                 add_network_security_proto(dict, ssid);
3101                 break;
3102         }
3103
3104         supplicant_dbus_dict_append_basic(dict, "key_mgmt",
3105                                 DBUS_TYPE_STRING, &key_mgmt);
3106 }
3107
3108 static void add_network_mode(DBusMessageIter *dict, GSupplicantSSID *ssid)
3109 {
3110         dbus_uint32_t mode;
3111
3112         switch (ssid->mode) {
3113         case G_SUPPLICANT_MODE_UNKNOWN:
3114         case G_SUPPLICANT_MODE_INFRA:
3115                 mode = 0;
3116                 break;
3117         case G_SUPPLICANT_MODE_IBSS:
3118                 mode = 1;
3119                 break;
3120         case G_SUPPLICANT_MODE_MASTER:
3121                 mode = 2;
3122                 break;
3123         }
3124
3125         supplicant_dbus_dict_append_basic(dict, "mode",
3126                                 DBUS_TYPE_UINT32, &mode);
3127 }
3128
3129 static void interface_add_network_params(DBusMessageIter *iter, void *user_data)
3130 {
3131         DBusMessageIter dict;
3132         struct interface_connect_data *data = user_data;
3133         GSupplicantSSID *ssid = data->ssid;
3134
3135         supplicant_dbus_dict_open(iter, &dict);
3136
3137         if (ssid->scan_ssid)
3138                 supplicant_dbus_dict_append_basic(&dict, "scan_ssid",
3139                                          DBUS_TYPE_UINT32, &ssid->scan_ssid);
3140
3141         if (ssid->freq)
3142                 supplicant_dbus_dict_append_basic(&dict, "frequency",
3143                                          DBUS_TYPE_UINT32, &ssid->freq);
3144
3145         if (ssid->bgscan != NULL)
3146                 supplicant_dbus_dict_append_basic(&dict, "bgscan",
3147                                         DBUS_TYPE_STRING, &ssid->bgscan);
3148
3149         add_network_mode(&dict, ssid);
3150
3151         add_network_security(&dict, ssid);
3152
3153         supplicant_dbus_dict_append_fixed_array(&dict, "ssid",
3154                                         DBUS_TYPE_BYTE, &ssid->ssid,
3155                                                 ssid->ssid_len);
3156
3157         supplicant_dbus_dict_close(iter, &dict);
3158 }
3159
3160 static void interface_wps_start_result(const char *error,
3161                                 DBusMessageIter *iter, void *user_data)
3162 {
3163         struct interface_connect_data *data = user_data;
3164
3165         SUPPLICANT_DBG("");
3166         if (error != NULL)
3167                 SUPPLICANT_DBG("error: %s", error);
3168
3169         g_free(data->ssid);
3170         dbus_free(data);
3171 }
3172
3173 static void interface_add_wps_params(DBusMessageIter *iter, void *user_data)
3174 {
3175         struct interface_connect_data *data = user_data;
3176         GSupplicantSSID *ssid = data->ssid;
3177         const char *role = "enrollee", *type;
3178         DBusMessageIter dict;
3179
3180         SUPPLICANT_DBG("");
3181
3182         supplicant_dbus_dict_open(iter, &dict);
3183
3184         supplicant_dbus_dict_append_basic(&dict, "Role",
3185                                                 DBUS_TYPE_STRING, &role);
3186
3187         type = "pbc";
3188         if (ssid->pin_wps != NULL) {
3189                 type = "pin";
3190                 supplicant_dbus_dict_append_basic(&dict, "Pin",
3191                                         DBUS_TYPE_STRING, &ssid->pin_wps);
3192         }
3193
3194         supplicant_dbus_dict_append_basic(&dict, "Type",
3195                                         DBUS_TYPE_STRING, &type);
3196
3197         supplicant_dbus_dict_close(iter, &dict);
3198 }
3199
3200 static void wps_start(const char *error, DBusMessageIter *iter, void *user_data)
3201 {
3202         struct interface_connect_data *data = user_data;
3203
3204         SUPPLICANT_DBG("");
3205
3206         if (error != NULL) {
3207                 SUPPLICANT_DBG("error: %s", error);
3208                 g_free(data->ssid);
3209                 dbus_free(data);
3210                 return;
3211         }
3212
3213         supplicant_dbus_method_call(data->interface->path,
3214                         SUPPLICANT_INTERFACE ".Interface.WPS", "Start",
3215                         interface_add_wps_params,
3216                         interface_wps_start_result, data);
3217 }
3218
3219 static void wps_process_credentials(DBusMessageIter *iter, void *user_data)
3220 {
3221         dbus_bool_t credentials = TRUE;
3222
3223         SUPPLICANT_DBG("");
3224
3225         dbus_message_iter_append_basic(iter, DBUS_TYPE_BOOLEAN, &credentials);
3226 }
3227
3228
3229 int g_supplicant_interface_connect(GSupplicantInterface *interface,
3230                                 GSupplicantSSID *ssid,
3231                                 GSupplicantInterfaceCallback callback,
3232                                                         void *user_data)
3233 {
3234         struct interface_connect_data *data;
3235         int ret;
3236
3237         if (interface == NULL)
3238                 return -EINVAL;
3239
3240         if (system_available == FALSE)
3241                 return -EFAULT;
3242
3243         /* TODO: Check if we're already connected and switch */
3244
3245         data = dbus_malloc0(sizeof(*data));
3246         if (data == NULL)
3247                 return -ENOMEM;
3248
3249         data->interface = interface;
3250         data->callback = callback;
3251         data->ssid = ssid;
3252         data->user_data = user_data;
3253
3254         if (ssid->use_wps == TRUE) {
3255                 g_free(interface->wps_cred.key);
3256                 memset(&interface->wps_cred, 0,
3257                                 sizeof(struct _GSupplicantWpsCredentials));
3258
3259                 ret = supplicant_dbus_property_set(interface->path,
3260                         SUPPLICANT_INTERFACE ".Interface.WPS",
3261                         "ProcessCredentials", DBUS_TYPE_BOOLEAN_AS_STRING,
3262                         wps_process_credentials, wps_start, data);
3263         } else
3264                 ret = supplicant_dbus_method_call(interface->path,
3265                         SUPPLICANT_INTERFACE ".Interface", "AddNetwork",
3266                         interface_add_network_params,
3267                         interface_add_network_result, data);
3268
3269         if (ret < 0)
3270                 return ret;
3271
3272         return -EINPROGRESS;
3273 }
3274
3275 static void network_remove_result(const char *error,
3276                                 DBusMessageIter *iter, void *user_data)
3277 {
3278         struct interface_data *data = user_data;
3279         int result = 0;
3280
3281         SUPPLICANT_DBG("");
3282
3283         if (error != NULL)
3284                 result = -EIO;
3285
3286         if (data->callback != NULL)
3287                 data->callback(result, data->interface, data->user_data);
3288
3289         dbus_free(data);
3290 }
3291
3292 static void network_remove_params(DBusMessageIter *iter, void *user_data)
3293 {
3294         struct interface_data *data = user_data;
3295         const char *path = data->interface->network_path;
3296
3297         SUPPLICANT_DBG("path %s", path);
3298
3299         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH, &path);
3300 }
3301
3302 static int network_remove(struct interface_data *data)
3303 {
3304         GSupplicantInterface *interface = data->interface;
3305
3306         SUPPLICANT_DBG("");
3307
3308         return supplicant_dbus_method_call(interface->path,
3309                         SUPPLICANT_INTERFACE ".Interface", "RemoveNetwork",
3310                         network_remove_params, network_remove_result, data);
3311 }
3312
3313 static void interface_disconnect_result(const char *error,
3314                                 DBusMessageIter *iter, void *user_data)
3315 {
3316         struct interface_data *data = user_data;
3317
3318         SUPPLICANT_DBG("");
3319
3320         if (error != NULL && data->callback != NULL)
3321                 data->callback(-EIO, data->interface, data->user_data);
3322
3323         /* If we are disconnecting from previous WPS successful
3324          * association. i.e.: it did not went through AddNetwork,
3325          * and interface->network_path was never set. */
3326         if (data->interface->network_path == NULL)
3327                 return;
3328
3329         network_remove(data);
3330 }
3331
3332 int g_supplicant_interface_disconnect(GSupplicantInterface *interface,
3333                                         GSupplicantInterfaceCallback callback,
3334                                                         void *user_data)
3335 {
3336         struct interface_data *data;
3337
3338         SUPPLICANT_DBG("");
3339
3340         if (interface == NULL)
3341                 return -EINVAL;
3342
3343         if (system_available == FALSE)
3344                 return -EFAULT;
3345
3346         data = dbus_malloc0(sizeof(*data));
3347         if (data == NULL)
3348                 return -ENOMEM;
3349
3350         data->interface = interface;
3351         data->callback = callback;
3352         data->user_data = user_data;
3353
3354         return supplicant_dbus_method_call(interface->path,
3355                         SUPPLICANT_INTERFACE ".Interface", "Disconnect",
3356                                 NULL, interface_disconnect_result, data);
3357 }
3358
3359
3360 static const char *g_supplicant_rule0 = "type=signal,"
3361                                         "path=" DBUS_PATH_DBUS ","
3362                                         "sender=" DBUS_SERVICE_DBUS ","
3363                                         "interface=" DBUS_INTERFACE_DBUS ","
3364                                         "member=NameOwnerChanged,"
3365                                         "arg0=" SUPPLICANT_SERVICE;
3366 static const char *g_supplicant_rule1 = "type=signal,"
3367                         "interface=" SUPPLICANT_INTERFACE;
3368 static const char *g_supplicant_rule2 = "type=signal,"
3369                         "interface=" SUPPLICANT_INTERFACE ".Interface";
3370 static const char *g_supplicant_rule3 = "type=signal,"
3371                         "interface=" SUPPLICANT_INTERFACE ".Interface.WPS";
3372 static const char *g_supplicant_rule4 = "type=signal,"
3373                         "interface=" SUPPLICANT_INTERFACE ".BSS";
3374 static const char *g_supplicant_rule5 = "type=signal,"
3375                         "interface=" SUPPLICANT_INTERFACE ".Network";
3376
3377 static void invoke_introspect_method(void)
3378 {
3379         DBusMessage *message;
3380
3381         message = dbus_message_new_method_call(SUPPLICANT_SERVICE,
3382                                         SUPPLICANT_PATH,
3383                                         DBUS_INTERFACE_INTROSPECTABLE,
3384                                         "Introspect");
3385
3386         if (message == NULL)
3387                 return;
3388
3389         dbus_message_set_no_reply(message, TRUE);
3390         dbus_connection_send(connection, message, NULL);
3391         dbus_message_unref(message);
3392 }
3393
3394 int g_supplicant_register(const GSupplicantCallbacks *callbacks)
3395 {
3396         connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
3397         if (connection == NULL)
3398                 return -EIO;
3399
3400         if (dbus_connection_add_filter(connection,
3401                                 g_supplicant_filter, NULL, NULL) == FALSE) {
3402                 dbus_connection_unref(connection);
3403                 connection = NULL;
3404                 return -EIO;
3405         }
3406
3407         callbacks_pointer = callbacks;
3408         eap_methods = 0;
3409
3410         interface_table = g_hash_table_new_full(g_str_hash, g_str_equal,
3411                                                 NULL, remove_interface);
3412
3413         bss_mapping = g_hash_table_new_full(g_str_hash, g_str_equal,
3414                                                                 NULL, NULL);
3415
3416         supplicant_dbus_setup(connection);
3417
3418         dbus_bus_add_match(connection, g_supplicant_rule0, NULL);
3419         dbus_bus_add_match(connection, g_supplicant_rule1, NULL);
3420         dbus_bus_add_match(connection, g_supplicant_rule2, NULL);
3421         dbus_bus_add_match(connection, g_supplicant_rule3, NULL);
3422         dbus_bus_add_match(connection, g_supplicant_rule4, NULL);
3423         dbus_bus_add_match(connection, g_supplicant_rule5, NULL);
3424         dbus_connection_flush(connection);
3425
3426         if (dbus_bus_name_has_owner(connection,
3427                                         SUPPLICANT_SERVICE, NULL) == TRUE) {
3428                 system_available = TRUE;
3429                 supplicant_dbus_property_get_all(SUPPLICANT_PATH,
3430                                                 SUPPLICANT_INTERFACE,
3431                                                 service_property, NULL);
3432         } else
3433                 invoke_introspect_method();
3434
3435         return 0;
3436 }
3437
3438 static void unregister_interface_remove_params(DBusMessageIter *iter,
3439                                                 void *user_data)
3440 {
3441         const char *path = user_data;
3442
3443         dbus_message_iter_append_basic(iter, DBUS_TYPE_OBJECT_PATH,
3444                                                         &path);
3445 }
3446
3447
3448 static void unregister_remove_interface(gpointer key, gpointer value,
3449                                                 gpointer user_data)
3450 {
3451         GSupplicantInterface *interface = value;
3452
3453         supplicant_dbus_method_call(SUPPLICANT_PATH,
3454                                         SUPPLICANT_INTERFACE,
3455                                         "RemoveInterface",
3456                                         unregister_interface_remove_params,
3457                                                 NULL, interface->path);
3458 }
3459
3460 void g_supplicant_unregister(const GSupplicantCallbacks *callbacks)
3461 {
3462         SUPPLICANT_DBG("");
3463
3464         if (connection != NULL) {
3465                 dbus_bus_remove_match(connection, g_supplicant_rule5, NULL);
3466                 dbus_bus_remove_match(connection, g_supplicant_rule4, NULL);
3467                 dbus_bus_remove_match(connection, g_supplicant_rule3, NULL);
3468                 dbus_bus_remove_match(connection, g_supplicant_rule2, NULL);
3469                 dbus_bus_remove_match(connection, g_supplicant_rule1, NULL);
3470                 dbus_bus_remove_match(connection, g_supplicant_rule0, NULL);
3471                 dbus_connection_flush(connection);
3472
3473                 dbus_connection_remove_filter(connection,
3474                                                 g_supplicant_filter, NULL);
3475         }
3476
3477         if (bss_mapping != NULL) {
3478                 g_hash_table_destroy(bss_mapping);
3479                 bss_mapping = NULL;
3480         }
3481
3482         if (system_available == TRUE)
3483                 callback_system_killed();
3484
3485         if (interface_table != NULL) {
3486                 g_hash_table_foreach(interface_table,   
3487                                         unregister_remove_interface, NULL);
3488                 g_hash_table_destroy(interface_table);
3489                 interface_table = NULL;
3490         }
3491
3492         if (connection != NULL) {
3493                 dbus_connection_unref(connection);
3494                 connection = NULL;
3495         }
3496
3497         callbacks_pointer = NULL;
3498         eap_methods = 0;
3499 }