2 * Network Configuration Module
4 * Copyright (c) 2012 Samsung Electronics Co., Ltd. All rights reserved.
6 * Licensed under the Apache License, Version 2.0 (the "License");
7 * you may not use this file except in compliance with the License.
8 * You may obtain a copy of the License at
10 * http://www.apache.org/licenses/LICENSE-2.0
12 * Unless required by applicable law or agreed to in writing, software
13 * distributed under the License is distributed on an "AS IS" BASIS,
14 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
15 * See the License for the specific language governing permissions and
16 * limitations under the License.
21 * This file implements wifi direct wpasupplicant dbus plugin functions.
23 * @file wfd-plugin-dbus-wpasupplicant.c
24 * @author Jiung Yu (jiung.yu@samsung.com)
31 #include <sys/types.h>
33 #include <sys/socket.h>
40 #include <sys/ioctl.h>
46 #include <tzplatform_config.h>
49 #include "wifi-direct-oem.h"
50 #include "wfd-plugin-log.h"
51 #include "dbus/wfd-plugin-supplicant-dbus.h"
52 #include "wfd-plugin-wpasupplicant.h"
54 #define GLIST_ITER_START(arg_list, elem)\
56 temp = g_list_first(arg_list);\
59 temp = g_list_next(temp);\
61 #define GLIST_ITER_END() }
63 #define NETCONFIG_SERVICE "net.netconfig"
64 #define NETCONFIG_WIFI_INTERFACE "net.netconfig.wifi"
65 #define NETCONFIG_WIFI_PATH "/net/netconfig/wifi"
67 #define NETCONFIG_DBUS_REPLY_TIMEOUT (10 * 1000)
69 #define CONF_FILE_PATH tzplatform_mkpath(TZ_SYS_ETC, "wpa_supplicant/wpa_supplicant.conf")
70 #define MAX_FILE_PATH_LEN 256
72 static wfd_oem_ops_s supplicant_ops = {
73 .configure = ws_configure,
76 .activate = ws_activate,
77 .deactivate = ws_deactivate,
79 .start_scan = ws_start_scan,
80 .stop_scan = ws_stop_scan,
81 .get_visibility = ws_get_visibility,
82 .set_visibility = ws_set_visibility,
83 .get_scan_result = ws_get_scan_result,
84 .get_peer_info = ws_get_peer_info,
86 .prov_disc_req = ws_prov_disc_req,
88 .connect = ws_connect,
89 .disconnect = ws_disconnect,
90 .reject_connection = ws_reject_connection,
91 .cancel_connection = ws_cancel_connection,
93 .get_connected_peers = ws_get_connected_peers,
94 .get_pin = ws_get_pin,
95 .set_pin = ws_set_pin,
96 .generate_pin = ws_generate_pin,
97 .get_supported_wps_mode = ws_get_supported_wps_mode,
99 .create_group = ws_create_group,
100 .destroy_group = ws_destroy_group,
102 .wps_start = ws_wps_start,
103 .enrollee_start = ws_enrollee_start,
104 .wps_cancel = ws_wps_cancel,
106 .get_dev_name = ws_get_dev_name,
107 .set_dev_name = ws_set_dev_name,
108 .get_dev_mac = ws_get_dev_mac,
109 .get_dev_type = ws_get_dev_type,
110 .set_dev_type = ws_set_dev_type,
111 .get_go_intent = ws_get_go_intent,
112 .set_go_intent = ws_set_go_intent,
113 .set_country = ws_set_country,
114 .get_persistent_groups = ws_get_persistent_groups,
115 .remove_persistent_group = ws_remove_persistent_group,
116 .set_persistent_reconnect = ws_set_persistent_reconnect,
118 .start_service_discovery = ws_start_service_discovery,
119 .cancel_service_discovery = ws_cancel_service_discovery,
121 .serv_add = ws_serv_add,
122 .serv_del = ws_serv_del,
124 .miracast_init = ws_miracast_init,
125 .set_display = ws_set_display,
127 .refresh = ws_refresh,
128 .save_config = ws_save_config,
129 .set_operating_channel = ws_set_operating_channel,
130 .remove_all_network = ws_remove_all_network,
131 .get_wpa_status = ws_get_wpa_status,
133 .advertise_service = ws_advertise_service,
134 .cancel_advertise_service = ws_cancel_advertise_service,
135 .seek_service = ws_seek_service,
136 .cancel_seek_service = ws_cancel_seek_service,
137 .asp_prov_disc_req = ws_asp_prov_disc_req,
139 .set_eapol_ip_config = ws_set_eapol_ip_config,
141 .add_vsie = ws_add_vsie,
142 .get_vsie = ws_get_vsie,
143 .remove_vsie = ws_remove_vsie,
144 .set_supported_wps_mode = ws_set_supported_wps_mode,
145 .remove_persistent_device = ws_remove_persistent_device,
146 .remove_all_persistent_device = ws_remove_all_persistent_device,
148 .get_supported_channels = ws_get_supported_channels,
153 static ws_dbus_plugin_data_s *g_pd;
154 static wfd_oem_config_s *config = NULL;
155 static int is_peer_joined_notified = 0;
156 static int is_peer_disconnected_notified = 0;
157 static int wps_config_method = WFD_OEM_WPS_MODE_PBC|WFD_OEM_WPS_MODE_DISPLAY|WFD_OEM_WPS_MODE_KEYPAD;
159 static GList *service_list;
160 static GList *seek_list;
162 static int __ws_txt_to_mac(unsigned char *txt, unsigned char *mac)
167 WDP_LOGE("Invalid parameter");
172 mac[i++] = (char) strtoul((char *)txt, (char **)&txt, 16);
173 if (!*txt++ || i == 6)
177 if (i != WS_MACADDR_LEN)
180 WDP_LOGD("Converted MAC address [" MACSECSTR "]", MAC2SECSTR(mac));
184 static int __ws_mac_compact_to_normal(char *compact, unsigned char *mac)
186 g_snprintf((char *)mac, OEM_MACSTR_LEN, "%c%c:%c%c:%c%c:%c%c:%c%c:%c%c",
187 compact[0], compact[1], compact[2], compact[3],
188 compact[4], compact[5], compact[6], compact[7],
189 compact[8], compact[9], compact[10], compact[11]);
193 static const char *__ws_wps_to_txt(int wps_mode)
196 case WFD_OEM_WPS_MODE_PBC:
197 return WS_DBUS_STR_PBC;
198 case WFD_OEM_WPS_MODE_DISPLAY:
199 return WS_DBUS_STR_DISPLAY;
200 case WFD_OEM_WPS_MODE_KEYPAD:
201 return WS_DBUS_STR_KEYPAD;
202 case WFD_OEM_WPS_MODE_NONE:
203 case WFD_OEM_WPS_MODE_P2PS:
204 return WS_DBUS_STR_P2PS;
210 static int __ws_hex_char_to_num(char c)
212 if (c >= '0' && c <= '9')
215 if (c >= 'a' && c <= 'f')
218 if (c >= 'A' && c <= 'F')
224 static int __ws_hex_to_byte(const char *hex)
228 a = __ws_hex_char_to_num(*hex++);
232 b = __ws_hex_char_to_num(*hex++);
239 static int __ws_hex_str_to_bin(const char *hex, unsigned char *buf, size_t len)
243 const char *ipos = hex;
244 unsigned char *opos = buf;
246 for (i = 0; i < len; i++) {
247 a = __ws_hex_to_byte(ipos);
258 static int __ws_byte_to_hex(char *buf, int buf_size, unsigned char *data, int data_len)
262 char *end = buf + buf_size;
266 for (i = 0; i < data_len; i++) {
267 ret = snprintf(pos, end - pos, "%02x", data[i]);
268 if (ret < 0 || ret >= end - pos) {
278 static int __ws_hex_to_num(char *src, int len)
283 if (!src || len < 0) {
284 WDP_LOGE("Invalid parameter");
288 temp = (char*) g_try_malloc0(len+1);
290 WDP_LOGE("Failed to allocate memory");
294 memcpy(temp, src, len);
295 num = strtoul(temp, NULL, 16);
301 static int __ws_segment_to_service(char *segment, wfd_oem_new_service_s **service)
303 wfd_oem_new_service_s *serv_tmp = NULL;
308 if (!segment || !service) {
309 WDP_LOGE("Invalid parameter");
314 WDP_LOGD("Segment: %s", segment);
316 serv_tmp = (wfd_oem_new_service_s*) g_try_malloc0(sizeof(wfd_oem_new_service_s));
318 WDP_LOGE("Failed to allocate memory for service");
322 serv_tmp->protocol = __ws_hex_to_num(ptr, 2);
323 serv_tmp->trans_id = __ws_hex_to_num(ptr+2, 2);
324 serv_tmp->status = __ws_hex_to_num(ptr+4, 2);
326 WDP_LOGD("Protocol[%d], Transaction ID[%d], Status[%d]", serv_tmp->protocol, serv_tmp->trans_id, serv_tmp->status);
328 if (serv_tmp->status != 0) {
329 WDP_LOGE("Service status is not success");
334 if (serv_tmp->protocol == WFD_OEM_SERVICE_TYPE_BONJOUR) {
335 WDP_LOGD("===== Bonjour service =====");
336 char compr[5] = {0, };
337 char query[256] = {0, };
338 char rdata[256] = {0, };
341 while (*ptr != 0 && strncmp(ptr, "c0", 2)) {
342 unsigned long int size = 0;
343 char temp_str[3] = {0,};
344 memcpy(temp_str, ptr, 2);
345 size = strtoul(temp_str, NULL, 16);
348 temp = (char*) calloc(1, size + 2);
351 for (i = 0; i < size; i++) {
352 temp[i+1] = (char) __ws_hex_to_num(ptr, 2);
355 g_strlcat(query, temp, sizeof(query));
362 if (!strncmp(ptr, "c0", 2)) {
363 memcpy(compr, ptr, 4);
366 if (!strncmp(ptr, "27", 2)) {
367 WDP_LOGD("Segment ended");
371 dns_type = __ws_hex_to_num(ptr, 4);
373 if (dns_type == 12) {
374 if (!strncmp(compr, "c011", 4))
375 g_strlcat(query, ".local.", sizeof(query));
376 else if (!strncmp(compr, "c00c", 4))
377 g_strlcat(query, "._tcp.local.", sizeof(query));
378 else if (!strncmp(compr, "c01c", 4))
379 g_strlcat(query, "._udp.local.", sizeof(query));
383 serv_tmp->data.bonjour.query = strdup(query + 1);
384 while (*ptr != 0 && strncmp(ptr, "c0", 2)) {
385 unsigned long int size = 0;
386 char temp_str[3] = {0,};
387 memcpy(temp_str, ptr, 2);
388 size = strtoul(temp_str, NULL, 16);
391 temp = (char*) g_try_malloc0(size + 2);
394 for (i = 0; i < size; i++) {
395 temp[i+1] = (char) __ws_hex_to_num(ptr, 2);
398 g_strlcat(rdata, temp, sizeof(rdata));
404 serv_tmp->data.bonjour.rdata = strdup(rdata + 1);
406 WDP_LOGD("Query: %s", serv_tmp->data.bonjour.query);
407 WDP_LOGD("RData: %s", serv_tmp->data.bonjour.rdata);
409 WDP_LOGE("Not supported yet. Only bonjour service supproted [%d]",
420 static void __extract_addr_from_path(char *peer_path, unsigned char *dev_addr)
422 static unsigned char peer_dev[WS_MACSTR_LEN] = {'\0',};
425 if (!peer_path || !dev_addr)
428 loc = strrchr(peer_path, '/');
430 __ws_mac_compact_to_normal(loc + 1, peer_dev);
432 __ws_txt_to_mac(peer_dev, dev_addr);
433 WDP_LOGD("dev addr [" MACSTR "]", MAC2STR(dev_addr));
436 static void __ws_path_to_addr(char *peer_path,
437 unsigned char *dev_addr, GVariant *parameter)
439 __WDP_LOG_FUNC_ENTER__;
441 const char *path = NULL;
443 g_variant_get(parameter, "(&o)", &path);
444 g_strlcpy(peer_path, path, DBUS_OBJECT_PATH_MAX);
445 WDP_LOGD("Retrive Added path [%s]", peer_path);
447 __extract_addr_from_path(peer_path, dev_addr);
449 __WDP_LOG_FUNC_EXIT__;
453 static int __ws_unpack_ay(unsigned char *dst, GVariant *src, int size)
455 GVariantIter *iter = NULL;
458 if (!dst || !src || size == 0) {
459 WDP_LOGE("Invalid parameter");
462 g_variant_get(src, "ay", &iter);
464 WDP_LOGE("failed to get iterator");
468 while (g_variant_iter_loop(iter, "y", &dst[length])) {
473 g_variant_iter_free(iter);
478 static int __ws_byte_to_txt(const unsigned char *src, char **dst, int src_len)
480 __WDP_LOG_FUNC_ENTER__;
487 WDP_LOGE("Invalid parameter.");
488 __WDP_LOG_FUNC_EXIT__;
492 *dst = (char *) g_try_malloc0((2*src_len)+1);
494 WDP_LOGE("failed to allocate memory to buffer.");
495 __WDP_LOG_FUNC_EXIT__;
501 for (i = 0; i < src_len; i++) {
502 snprintf(buf, 3, "%02x", src[i]);
507 __WDP_LOG_FUNC_EXIT__;
511 static int __ws_unpack_ay_malloc(unsigned char **dst, GVariantIter *iter)
513 GVariantIter *iter_copy = NULL;
516 unsigned char *tmp_dst = NULL;
518 if (!dst || *dst || !iter) {
519 WDP_LOGE("Invalid parameter");
523 iter_copy = g_variant_iter_copy(iter);
525 while (g_variant_iter_loop(iter, "y", &tmp))
527 g_variant_iter_free(iter);
529 tmp_dst = (unsigned char *)g_try_malloc0(length + 1);
531 WDP_LOGE("failed to allocate memory");
532 g_variant_iter_free(iter_copy);
537 while (g_variant_iter_loop(iter_copy, "y", &tmp_dst[length]))
539 g_variant_iter_free(iter_copy);
545 tmp_dst[length] = '\0';
549 WDP_LOGD("Length [%d]", length);
553 static int __parsing_wfd_info(unsigned char *wfd_dev_info,
554 wfd_oem_display_s* display)
556 __WDP_LOG_FUNC_ENTER__;
559 if (!wfd_dev_info || !display) {
560 WDP_LOGE("Invalid parameter");
561 __WDP_LOG_FUNC_EXIT__;
565 wfd_info = (wfd_dev_info[3]<<8 | wfd_dev_info[4]);
567 if (wfd_info & WS_WFD_INFO_PRIMARY_SINK)
568 display->type |= WS_WFD_INFO_PRIMARY_SINK;
569 if (wfd_info & WS_WFD_INFO_SECONDARY_SINK)
570 display->type |= WS_WFD_INFO_SECONDARY_SINK;
572 display->availability = (wfd_info & WS_WFD_INFO_AVAILABILITY) >> 4;
573 display->hdcp_support = (wfd_info & WS_WFD_INFO_HDCP_SUPPORT) >> 8;
575 display->port = (wfd_dev_info[5]<<8 | wfd_dev_info[6]);
576 display->max_tput = (wfd_dev_info[7]<<8 | wfd_dev_info[8]);
578 WDP_LOGD("type [%d],availability [%d],hdcp_support [%d],ctrl_port [%d] "
579 "max_tput[%d]", display->type, display->availability,
580 display->hdcp_support, display->port, display->max_tput);
582 __WDP_LOG_FUNC_EXIT__;
586 static int _ws_get_local_dev_mac(unsigned char *dev_mac)
588 __WDP_LOG_FUNC_ENTER__;
590 char file_path[MAX_FILE_PATH_LEN] = {0, };
591 char local_mac[OEM_MACSTR_LEN] = {0, };
594 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
597 g_snprintf(file_path, sizeof(file_path),
598 "/sys/class/net/%s/address", config->p2p_ifname);
600 fd = fopen(file_path, "r");
602 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
603 WDP_LOGE("Failed to open MAC info file [%s] (%s)", file_path, error_buf);
604 __WDP_LOG_FUNC_EXIT__;
609 ptr = fgets((char *)local_mac, WS_MACSTR_LEN, fd);
611 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
612 WDP_LOGE("Failed to read file or no data read(%s)", error_buf);
614 __WDP_LOG_FUNC_EXIT__;
617 WDP_SECLOGD("Local MAC address [%s]", ptr);
618 WDP_SECLOGD("Local MAC address [%s]", local_mac);
620 res = __ws_txt_to_mac((unsigned char *)local_mac, dev_mac);
622 WDP_LOGE("Failed to convert text to MAC address");
624 __WDP_LOG_FUNC_EXIT__;
628 WDP_LOGD("Local Device MAC address [" MACSECSTR "]", MAC2SECSTR(dev_mac));
631 __WDP_LOG_FUNC_EXIT__;
635 static void _ws_manage_group_iface_signal(const gchar *group_iface_obj_path,
636 gboolean is_created);
638 static void _ws_process_interface_removed(GDBusConnection *connection,
639 const gchar *sender, const gchar *object_path, const gchar *interface,
640 const gchar *signal, GVariant *parameters, gpointer user_data)
642 __WDP_LOG_FUNC_ENTER__;
643 static char interface_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
644 const char *path = NULL;
646 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
649 WDP_LOGD("Ignoring event");
650 __WDP_LOG_FUNC_EXIT__;
654 g_variant_get(parameters, "(&o)", &path);
655 g_strlcpy(interface_path, path, DBUS_OBJECT_PATH_MAX);
657 WDP_LOGD("Retrive removed path [%s]", interface_path);
659 if (!g_strcmp0(g_pd->group_iface_path, interface_path)) {
660 WDP_LOGD("p2p group interface removed");
661 memset(g_pd->group_iface_path, 0x0, DBUS_OBJECT_PATH_MAX);
662 } else if (!g_strcmp0(g_pd->iface_path, interface_path)) {
664 WDP_LOGD("p2p interface removed");
665 wfd_oem_event_s event;
669 memset(&event, 0x0, sizeof(wfd_oem_event_s));
670 event.event_id = WFD_OEM_EVENT_DEACTIVATED;
671 if (g_pd->callback && g_pd->callback->deactivated_cb)
672 g_pd->callback->deactivated_cb(&event);
674 memset(g_pd->iface_path, 0x0, DBUS_OBJECT_PATH_MAX);
676 __WDP_LOG_FUNC_EXIT__;
681 const char *interface;
683 void (*function) (GDBusConnection *connection,
684 const gchar *sender, const gchar *object_path, const gchar *interface,
685 const gchar *signal, GVariant *parameters, gpointer user_data);
686 } ws_supplicant_signal_map[] = {
689 SUPPLICANT_INTERFACE,
691 _ws_process_interface_removed
701 static void __ws_get_peer_property(const char *key, GVariant *value, void *user_data)
703 __WDP_LOG_FUNC_ENTER__;
705 wfd_oem_device_s *peer = (wfd_oem_device_s *)user_data;
707 __WDP_LOG_FUNC_EXIT__;
711 CHECK_KEY_VALUE(key, value);
713 if (g_strcmp0(key, "DeviceName") == 0) {
714 const char *name = NULL;
716 g_variant_get(value, "&s", &name);
717 g_strlcpy(peer->dev_name, name, WS_SSID_LEN + 1);
718 WDP_LOGD("Device name [%s]", peer->dev_name);
720 } else if (g_strcmp0(key, "config_method") == 0) {
721 int config_methods = 0;
722 g_variant_get(value, "q", &config_methods);
724 if (config_methods & WS_CONFIG_METHOD_DISPLAY)
725 peer->config_methods |= WFD_OEM_WPS_MODE_DISPLAY;
726 if (config_methods & WS_CONFIG_METHOD_PUSHBUTTON)
727 peer->config_methods |= WFD_OEM_WPS_MODE_PBC;
728 if (config_methods & WS_CONFIG_METHOD_KEYPAD)
729 peer->config_methods |= WFD_OEM_WPS_MODE_KEYPAD;
730 WDP_LOGD("Config method [0x%x]", peer->config_methods);
732 } else if (g_strcmp0(key, "level") == 0) {
735 g_variant_get(value, "i", &rssi);
737 WDP_LOGD("Peer RSSI [%d]", peer->rssi);
739 } else if (g_strcmp0(key, "devicecapability") == 0) {
740 unsigned char devicecapability = 0;
742 g_variant_get(value, "y", &devicecapability);
743 peer->dev_flags = (int)devicecapability;
744 WDP_LOGD("Device Capa [0x%02x]", peer->dev_flags);
746 } else if (g_strcmp0(key, "groupcapability") == 0) {
747 unsigned char groupcapability = 0;
749 g_variant_get(value, "y", &groupcapability);
750 WDP_LOGD("Group Capa [0x%02x]", groupcapability);
751 if (groupcapability & WS_GROUP_CAP_GROUP_OWNER) {
752 peer->group_flags = WFD_OEM_GROUP_FLAG_GROUP_OWNER;
753 peer->dev_role = WFD_OEM_DEV_ROLE_GO;
755 if (groupcapability & WS_GROUP_CAP_PERSISTENT_GROUP)
756 peer->group_flags = WFD_OEM_GROUP_FLAG_PERSISTENT_GROUP;
758 } else if (g_strcmp0(key, "PrimaryDeviceType") == 0) {
759 unsigned char primarydevicetype[WS_DEVTYPE_LEN] = {0,};
761 if (__ws_unpack_ay(primarydevicetype, value, WS_DEVTYPE_LEN)) {
762 peer->pri_dev_type = primarydevicetype[1];
763 peer->sec_dev_type = primarydevicetype[WS_DEVTYPE_LEN -1];
765 } else if (g_strcmp0(key, "SecondaryDeviceTypes") == 0) {
766 } else if (g_strcmp0(key, "VendorExtension") == 0) {
767 } else if (g_strcmp0(key, "IEs") == 0) {
768 unsigned char ies[WFD_SUBELEM_LEN_DEV_INFO + 3] = {0,};
770 if (__ws_unpack_ay(ies, value, WFD_SUBELEM_LEN_DEV_INFO + 3))
771 __parsing_wfd_info(ies, &(peer->display));
772 } else if (g_strcmp0(key, "DeviceAddress") == 0) {
774 if (__ws_unpack_ay(peer->dev_addr, value, WS_MACADDR_LEN))
775 WDP_LOGD("Device address [" MACSTR "]", MAC2STR(peer->dev_addr));
777 } else if (g_strcmp0(key, "InterfaceAddress") == 0) {
779 if (__ws_unpack_ay(peer->intf_addr, value, WS_MACADDR_LEN))
780 WDP_LOGD("Interface address [" MACSTR "]", MAC2STR(peer->intf_addr));
782 } else if (g_strcmp0(key, "GODeviceAddress") == 0) {
784 if (__ws_unpack_ay(peer->go_dev_addr, value, WS_MACADDR_LEN))
785 WDP_LOGD("GODevice address [" MACSTR "]", MAC2STR(peer->go_dev_addr));
787 if (!ISZEROMACADDR(peer->go_dev_addr))
788 peer->dev_role = WFD_OEM_DEV_ROLE_GC;
790 } else if (g_strcmp0(key, "VSIE") == 0) {
792 unsigned char vsie[OEM_VSIE_MAX_LEN] = {0,};
794 vsie_len = __ws_unpack_ay(vsie, value, OEM_VSIE_MAX_LEN);
796 __ws_byte_to_txt(vsie, (char **)&(peer->vsie), vsie_len);
797 WDP_LOGD("VSIE [%s]", peer->vsie);
801 WDP_LOGD("Unknown value");
803 __WDP_LOG_FUNC_EXIT__;
807 static void __ws_peer_property(const char *key, GVariant *value, void *user_data)
809 __WDP_LOG_FUNC_ENTER__;
811 __WDP_LOG_FUNC_EXIT__;
815 wfd_oem_dev_data_s *peer = (wfd_oem_dev_data_s *)user_data;
817 CHECK_KEY_VALUE(key, value);
819 if (g_strcmp0(key, "DeviceName") == 0) {
820 const char *name = NULL;
822 g_variant_get(value, "&s", &name);
823 g_strlcpy(peer->name, name, WS_SSID_LEN + 1);
824 WDP_LOGD("Device Name [%s]", peer->name);
826 } else if (g_strcmp0(key, "config_method") == 0) {
827 int config_methods = 0;
829 g_variant_get(value, "q", &config_methods);
831 if (config_methods & WS_CONFIG_METHOD_DISPLAY)
832 peer->config_methods |= WFD_OEM_WPS_MODE_DISPLAY;
833 if (config_methods & WS_CONFIG_METHOD_PUSHBUTTON)
834 peer->config_methods |= WFD_OEM_WPS_MODE_PBC;
835 if (config_methods & WS_CONFIG_METHOD_KEYPAD)
836 peer->config_methods |= WFD_OEM_WPS_MODE_KEYPAD;
837 WDP_LOGD("Config method [0x%x]", peer->config_methods);
839 } else if (g_strcmp0(key, "level") == 0) {
842 g_variant_get(value, "i", &rssi);
844 WDP_LOGD("Peer RSSI [%d]", peer->rssi);
846 } else if (g_strcmp0(key, "devicecapability") == 0) {
847 unsigned char devicecapability = 0;
849 g_variant_get(value, "y", &devicecapability);
850 peer->dev_flags = (int)devicecapability;
851 WDP_LOGD("Device Capa [0x%02x]", peer->dev_flags);
853 } else if (g_strcmp0(key, "groupcapability") == 0) {
854 unsigned char groupcapability = 0;
856 g_variant_get(value, "y", &groupcapability);
857 WDP_LOGD("Group Capa [0x%02x]", groupcapability);
858 if (groupcapability & WS_GROUP_CAP_GROUP_OWNER) {
859 peer->group_flags = WFD_OEM_GROUP_FLAG_GROUP_OWNER;
860 peer->dev_role = WFD_OEM_DEV_ROLE_GO;
862 if (groupcapability & WS_GROUP_CAP_PERSISTENT_GROUP)
863 peer->group_flags = WFD_OEM_GROUP_FLAG_PERSISTENT_GROUP;
865 } else if (g_strcmp0(key, "PrimaryDeviceType") == 0) {
866 unsigned char primarydevicetype[WS_DEVTYPE_LEN] = {0,};
868 if (__ws_unpack_ay(primarydevicetype, value, WS_DEVTYPE_LEN)) {
869 peer->pri_dev_type = primarydevicetype[1];
870 peer->sec_dev_type = primarydevicetype[WS_DEVTYPE_LEN -1];
872 } else if (g_strcmp0(key, "SecondaryDeviceTypes") == 0) {
873 } else if (g_strcmp0(key, "VendorExtension") == 0) {
874 } else if (g_strcmp0(key, "IEs") == 0) {
875 unsigned char ies[WFD_SUBELEM_LEN_DEV_INFO + 3] = {0,};
877 if (__ws_unpack_ay(ies, value, WFD_SUBELEM_LEN_DEV_INFO + 3))
878 __parsing_wfd_info(ies, &(peer->display));
879 } else if (g_strcmp0(key, "DeviceAddress") == 0) {
881 if (__ws_unpack_ay(peer->p2p_dev_addr, value, WS_MACADDR_LEN))
882 WDP_LOGD("Device address [" MACSTR "]", MAC2STR(peer->p2p_dev_addr));
884 } else if (g_strcmp0(key, "InterfaceAddress") == 0) {
886 if (__ws_unpack_ay(peer->p2p_intf_addr, value, WS_MACADDR_LEN))
887 WDP_LOGD("Interface Address [" MACSTR "]", MAC2STR(peer->p2p_intf_addr));
889 } else if (g_strcmp0(key, "GODeviceAddress") == 0) {
891 unsigned char go_dev_addr[OEM_MACADDR_LEN] = {0,};
892 if (__ws_unpack_ay(go_dev_addr, value, WS_MACADDR_LEN))
893 WDP_LOGD("[" MACSTR "]", MAC2STR(go_dev_addr));
895 if (!ISZEROMACADDR(go_dev_addr))
896 peer->dev_role = WFD_OEM_DEV_ROLE_GC;
898 } else if (g_strcmp0(key, "AdvertiseService") == 0) {
899 if (value != NULL && g_variant_get_size(value) != 0)
900 peer->has_asp_services = 1;
902 peer->has_asp_services = 0;
904 } else if (g_strcmp0(key, "AdvertiseASPService") == 0) {
905 if (value != NULL && g_variant_get_size(value) != 0)
906 peer->has_asp2_services = 1;
908 peer->has_asp2_services = 0;
910 } else if (g_strcmp0(key, "VSIE") == 0) {
912 unsigned char vsie[OEM_VSIE_MAX_LEN] = {0,};
914 vsie_len = __ws_unpack_ay(vsie, value, OEM_VSIE_MAX_LEN);
916 __ws_byte_to_txt(vsie, (char **)&(peer->vsie), vsie_len);
917 WDP_LOGD("VSIE [%s]", peer->vsie);
921 WDP_LOGD("Unknown value");
923 __WDP_LOG_FUNC_EXIT__;
927 void __ws_interface_property(const char *key, GVariant *value, void *user_data)
929 __WDP_LOG_FUNC_ENTER__;
930 wfd_oem_event_s *event = (wfd_oem_event_s *)user_data;
934 CHECK_KEY_VALUE(key, value);
936 if (g_strcmp0(key, "Ifname") == 0) {
937 const char *ifname = NULL;
939 g_variant_get(value, "&s", &ifname);
940 g_strlcpy(event->ifname, ifname, OEM_IFACE_NAME_LEN+1);
941 WDP_LOGD("Ifname [%s]", event->ifname);
944 __WDP_LOG_FUNC_EXIT__;
948 void __ws_group_property(const char *key, GVariant *value, void *user_data)
950 __WDP_LOG_FUNC_ENTER__;
951 wfd_oem_event_s *event = (wfd_oem_event_s *)user_data;
952 if (!event || !event->edata)
955 wfd_oem_group_data_s *group = (wfd_oem_group_data_s *)event->edata;
957 CHECK_KEY_VALUE(key, value);
959 if (g_strcmp0(key, "Role") == 0) {
960 const char *role = NULL;
962 g_variant_get(value, "&s", &role);
963 WDP_LOGD("Role [%s]", role);
965 if (!strncmp(role, "GO", 2))
966 event->dev_role = WFD_OEM_DEV_ROLE_GO;
967 else if (!strncmp(role, "client", 6))
968 event->dev_role = WFD_OEM_DEV_ROLE_GC;
970 } else if (g_strcmp0(key, "Frequency") == 0) {
973 g_variant_get(value, "q", &frequency);
974 group->freq = (int)frequency;
976 } else if (g_strcmp0(key, "Passphrase") == 0) {
977 const char *passphrase = NULL;
979 g_variant_get(value, "&s", &passphrase);
980 g_strlcpy(group->pass, passphrase, OEM_PASS_PHRASE_LEN+1);
981 WDP_LOGD("passphrase [%s]", group->pass);
983 } else if (g_strcmp0(key, "Group") == 0) {
985 } else if (g_strcmp0(key, "SSID") == 0) {
986 unsigned char ssid[WS_SSID_LEN +1] = {0,};
988 __ws_unpack_ay(ssid, value, WS_SSID_LEN);
989 memcpy(group->ssid, ssid, WS_SSID_LEN+1);
990 WDP_LOGD("ssid [%s]", group->ssid);
992 } else if (g_strcmp0(key, "BSSID") == 0) {
994 if (__ws_unpack_ay(group->go_dev_addr, value, WS_MACADDR_LEN))
995 WDP_LOGD("[" MACSTR "]", MAC2STR(group->go_dev_addr));
998 WDP_LOGD("Unknown value");
1000 __WDP_LOG_FUNC_EXIT__;
1004 void __ws_extract_invitation_details(const char *key, GVariant *value, void *user_data)
1006 __WDP_LOG_FUNC_ENTER__;
1007 wfd_oem_event_s *event = (wfd_oem_event_s *)user_data;
1008 if (!event || !event->edata)
1011 wfd_oem_invite_data_s *invitation = (wfd_oem_invite_data_s *)event->edata;
1013 CHECK_KEY_VALUE(key, value);
1015 if (g_strcmp0(key, "sa") == 0) {
1016 if (__ws_unpack_ay(invitation->sa, value, WS_MACADDR_LEN))
1017 WDP_LOGD("SA [" MACSTR "]", MAC2STR(invitation->sa));
1019 } else if (g_strcmp0(key, "go_dev_addr") == 0) {
1020 if (__ws_unpack_ay(invitation->go_dev_addr, value, WS_MACADDR_LEN))
1021 WDP_LOGD("GO device address [" MACSTR "]", MAC2STR(invitation->go_dev_addr));
1023 } else if (g_strcmp0(key, "bssid") == 0) {
1024 if (__ws_unpack_ay(invitation->bssid, value, WS_MACADDR_LEN))
1025 WDP_LOGD("BSSID [" MACSTR "]", MAC2STR(invitation->bssid));
1027 } else if (g_strcmp0(key, "persistent_id") == 0) {
1028 g_variant_get(value, "i", &(invitation->persistent_id));
1029 WDP_LOGD("persistent id [%d]", invitation->persistent_id);
1031 } else if (g_strcmp0(key, "op_freq") == 0) {
1032 g_variant_get(value, "i", &(invitation->oper_freq));
1033 WDP_LOGD("op freq [%d]", invitation->oper_freq);
1035 WDP_LOGD("Unknown value");
1037 __WDP_LOG_FUNC_EXIT__;
1041 static void __ws_parse_peer_joined(char *peer_path,
1042 unsigned char *dev_addr, unsigned char *ip_addr, GVariant *parameter)
1044 __WDP_LOG_FUNC_ENTER__;
1047 gboolean iter_res = TRUE;
1048 const char *path = NULL;
1051 g_variant_get(parameter, "(&oay)", &path, &iter);
1052 g_strlcpy(peer_path, path, DBUS_OBJECT_PATH_MAX);
1053 WDP_LOGD("Retrive Added path [%s]", peer_path);
1055 __extract_addr_from_path(peer_path, dev_addr);
1057 for (i = 0; iter_res && i < OEM_IPADDR_LEN; i++)
1058 iter_res = g_variant_iter_loop(iter, "y", &ip_addr[i]);
1059 g_variant_iter_free(iter);
1061 WDP_LOGD("peer ip [" IPSTR "]", IP2STR(ip_addr));
1063 __WDP_LOG_FUNC_EXIT__;
1067 static gboolean __is_valid_plugin(void)
1069 gboolean is_valid = (g_pd && g_pd->callback);
1072 WDP_LOGD("Ignoring event");
1077 static wfd_oem_dev_data_s *__create_dev_data(void)
1079 wfd_oem_dev_data_s *dev_data =
1080 (wfd_oem_dev_data_s *) g_try_malloc0(sizeof(wfd_oem_dev_data_s));
1082 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
1083 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
1084 WDP_LOGF("Failed to allocate memory for event. [%s]",
1091 static void __set_event_data(int event_id, int edata_type, void *data, wfd_oem_event_s *event)
1096 memset(event, 0x0, sizeof(wfd_oem_event_s));
1098 event->edata = data;
1099 event->edata_type = edata_type;
1100 event->event_id = event_id;
1105 static void __destroy_dev_data(wfd_oem_dev_data_s *dev_data)
1111 g_free(dev_data->vsie);
1115 static void _ws_process_peer_joined(GDBusConnection *connection,
1116 const gchar *sender, const gchar *object_path, const gchar *interface,
1117 const gchar *signal, GVariant *parameters, gpointer user_data)
1119 __WDP_LOG_FUNC_ENTER__;
1120 wfd_oem_event_s event;
1121 wfd_oem_dev_data_s *dev_data = NULL;
1122 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
1124 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
1126 if (!__is_valid_plugin())
1129 dev_data = __create_dev_data();
1131 __WDP_LOG_FUNC_EXIT__;
1135 __set_event_data(WFD_OEM_EVENT_STA_CONNECTED,
1136 WFD_OEM_EDATA_TYPE_DEVICE,
1140 __ws_parse_peer_joined(peer_path, event.dev_addr, event.ip_addr_peer, parameters);
1142 dbus_property_get_all(peer_path, g_pd->g_dbus, SUPPLICANT_P2P_PEER,
1143 __ws_peer_property, event.edata);
1145 if (g_pd->callback->sta_connected_cb)
1146 g_pd->callback->sta_connected_cb(&event);
1148 is_peer_joined_notified = 1;
1150 __destroy_dev_data(dev_data);
1152 __WDP_LOG_FUNC_EXIT__;
1155 static void _ws_process_peer_disconnected(GDBusConnection *connection,
1156 const gchar *sender, const gchar *object_path, const gchar *interface,
1157 const gchar *signal, GVariant *parameters, gpointer user_data)
1159 __WDP_LOG_FUNC_ENTER__;
1160 wfd_oem_event_s event;
1161 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
1163 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
1165 if (!g_pd || !g_pd->callback) {
1166 WDP_LOGD("Ignoring event");
1167 __WDP_LOG_FUNC_EXIT__;
1171 memset(&event, 0x0, sizeof(wfd_oem_event_s));
1173 event.edata_type = WFD_OEM_EDATA_TYPE_NONE;
1174 event.event_id = WFD_OEM_EVENT_STA_DISCONNECTED;
1176 __ws_path_to_addr(peer_path, event.dev_addr, parameters);
1178 if (g_pd->callback->sta_disconnected_cb)
1179 g_pd->callback->sta_disconnected_cb(&event);
1181 is_peer_disconnected_notified = 1;
1182 __WDP_LOG_FUNC_EXIT__;
1187 const char *interface;
1189 void (*function) (GDBusConnection *connection,
1190 const gchar *sender, const gchar *object_path, const gchar *interface,
1191 const gchar *signal, GVariant *parameters, gpointer user_data);
1192 } ws_group_signal_map[] = {
1195 SUPPLICANT_P2P_GROUP,
1197 _ws_process_peer_joined
1201 SUPPLICANT_P2P_GROUP,
1203 _ws_process_peer_disconnected
1213 void __ws_extract_group_details(const char *key, GVariant *value, void *user_data)
1215 __WDP_LOG_FUNC_ENTER__;
1216 wfd_oem_event_s *event = (wfd_oem_event_s *)user_data;
1217 if (!event || !event->edata)
1221 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
1222 __WDP_LOG_FUNC_EXIT__;
1226 wfd_oem_group_data_s *group = (wfd_oem_group_data_s *)event->edata;
1228 CHECK_KEY_VALUE(key, value);
1230 if (g_strcmp0(key, "interface_object") == 0) {
1231 static char interface_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
1232 const char *i_path = NULL;
1234 g_variant_get(value, "&o", &i_path);
1235 g_strlcpy(interface_path, i_path, DBUS_OBJECT_PATH_MAX);
1236 WDP_LOGD("Retrive Added path [%s]", interface_path);
1237 g_strlcpy(g_pd->group_iface_path, interface_path, DBUS_OBJECT_PATH_MAX);
1239 dbus_property_get_all(interface_path, g_pd->g_dbus,
1240 SUPPLICANT_IFACE, __ws_interface_property, event);
1242 _ws_manage_group_iface_signal(interface_path, TRUE);
1244 } else if (g_strcmp0(key, "role") == 0) {
1245 const char *role = NULL;
1247 g_variant_get(value, "&s", &role);
1248 WDP_LOGD("Role [%s]", role);
1250 if (!strncmp(role, "GO", 2))
1251 event->dev_role = WFD_OEM_DEV_ROLE_GO;
1252 else if (!strncmp(role, "client", 6))
1253 event->dev_role = WFD_OEM_DEV_ROLE_GC;
1254 } else if (g_strcmp0(key, "persistent") == 0) {
1255 g_variant_get(value, "b", &group->is_persistent);
1256 WDP_LOGD("Is Persistent : [%s]", group->is_persistent ? "YES" : "NO");
1258 } else if (g_strcmp0(key, "IpAddr") == 0) {
1260 if (__ws_unpack_ay(group->ip_addr, value, OEM_IPADDR_LEN))
1261 WDP_LOGD("IP address [" IPSTR "]", IP2STR(group->ip_addr));
1263 } else if (g_strcmp0(key, "IpAddrMask") == 0) {
1265 if (__ws_unpack_ay(group->ip_addr_mask, value, OEM_IPADDR_LEN))
1266 WDP_LOGD("IP mask [" IPSTR "]", IP2STR(group->ip_addr_mask));
1268 } else if (g_strcmp0(key, "IpAddrGo") == 0) {
1270 if (__ws_unpack_ay(group->ip_addr_go, value, OEM_IPADDR_LEN))
1271 WDP_LOGD("GO IP address [" IPSTR "]", IP2STR(group->ip_addr_go));
1272 } else if (g_strcmp0(key, "group_object") == 0) {
1273 static char group_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
1277 g_variant_get(value, "&o", &g_path);
1278 g_strlcpy(group_path, g_path, DBUS_OBJECT_PATH_MAX);
1279 WDP_LOGD("Retrive group path [%s]", group_path);
1280 dbus_property_get_all(group_path, g_pd->g_dbus, SUPPLICANT_P2P_GROUP,
1281 __ws_group_property, event);
1283 for (i = 0; ws_group_signal_map[i].member != NULL; i++) {
1284 ws_group_signal_map[i].sub_id =
1285 g_dbus_connection_signal_subscribe(g_pd->g_dbus,
1286 SUPPLICANT_SERVICE, /* bus name */
1287 ws_group_signal_map[i].interface, /* interface */
1288 ws_group_signal_map[i].member, /* member */
1289 group_path, /* object path */
1291 G_DBUS_SIGNAL_FLAGS_NONE,
1292 ws_group_signal_map[i].function,
1294 WDP_LOGD("Subscribed Group iface signal [%s]", ws_group_signal_map[i].member);
1297 __WDP_LOG_FUNC_EXIT__;
1301 void __ws_extract_gonegfailaure_details(const char *key, GVariant *value, void *user_data)
1303 __WDP_LOG_FUNC_ENTER__;
1304 wfd_oem_event_s *event = (wfd_oem_event_s *)user_data;
1305 if (!event || !event->edata)
1308 wfd_oem_conn_data_s *conn = (wfd_oem_conn_data_s *)event->edata;
1310 CHECK_KEY_VALUE(key, value);
1312 if (g_strcmp0(key, "peer_object") == 0) {
1313 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
1316 g_variant_get(value, "&o", &path);
1317 g_strlcpy(peer_path, path, DBUS_OBJECT_PATH_MAX);
1318 WDP_LOGD("Retrive peer path [%s]", peer_path);
1320 } else if (g_strcmp0(key, "status") == 0) {
1323 g_variant_get(value, "i", &status);
1324 WDP_LOGD("Retrive status [%d]", status);
1325 conn->status = status;
1327 __WDP_LOG_FUNC_EXIT__;
1331 void __ws_extract_gonegsuccess_details(const char *key, GVariant *value, void *user_data)
1333 __WDP_LOG_FUNC_ENTER__;
1334 wfd_oem_event_s *event = (wfd_oem_event_s *)user_data;
1335 if (!event || !event->edata)
1338 wfd_oem_conn_data_s *edata = (wfd_oem_conn_data_s *)event->edata;
1340 CHECK_KEY_VALUE(key, value);
1342 if (g_strcmp0(key, "peer_object") == 0) {
1344 } else if (g_strcmp0(key, "status") == 0) {
1346 } else if (g_strcmp0(key, "passphrase") == 0) {
1348 } else if (g_strcmp0(key, "role_go") == 0) {
1349 /* local device role */
1350 const char *role = NULL;
1352 g_variant_get(value, "&s", &role);
1353 if (!strncmp(role, "GO", 2))
1354 event->dev_role = WFD_OEM_DEV_ROLE_GO;
1355 else if (!strncmp(role, "client", 6))
1356 event->dev_role = WFD_OEM_DEV_ROLE_GC;
1358 } else if (g_strcmp0(key, "ssid") == 0) {
1359 unsigned char ssid[WS_SSID_LEN +1] = {0,};
1361 __ws_unpack_ay(ssid, value, WS_SSID_LEN);
1362 memcpy(edata->ssid, ssid, WS_SSID_LEN+1);
1363 WDP_LOGD("ssid [%s]", edata->ssid);
1365 } else if (g_strcmp0(key, "peer_device_addr") == 0) {
1367 if (__ws_unpack_ay(edata->peer_device_addr, value, WS_MACADDR_LEN))
1368 WDP_LOGD("Device address[" MACSTR "]", MAC2STR(edata->peer_device_addr));
1370 } else if (g_strcmp0(key, "peer_interface_addr") == 0) {
1372 if (__ws_unpack_ay(edata->peer_intf_addr, value, WS_MACADDR_LEN))
1373 WDP_LOGD("Interface address [" MACSTR "]", MAC2STR(edata->peer_intf_addr));
1375 } else if (g_strcmp0(key, "wps_method") == 0) {
1377 } else if (g_strcmp0(key, "frequency_list") == 0) {
1379 } else if (g_strcmp0(key, "persistent_group") == 0) {
1381 g_variant_get(value, "i", &(edata->persistent_group));
1382 WDP_LOGD("persistent_group [%d]", edata->persistent_group);
1384 } else if (g_strcmp0(key, "peer_config_timeout") == 0) {
1387 __WDP_LOG_FUNC_EXIT__;
1391 void __ws_extract_peer_service(wfd_oem_event_s *data, unsigned char *service_hex, int tlvs_len)
1393 GList *services = NULL;
1394 wfd_oem_new_service_s *new_service = NULL;
1395 char *segment = NULL;
1401 while (ptr + 2 < WS_MAX_SERVICE_LEN &&
1402 (length = (service_hex[ptr+1]*256) + service_hex[ptr]) > 0) {
1403 segment = (char*) g_try_malloc0(length*2+1);
1405 __ws_byte_to_hex(segment, length * 2 + 1, &service_hex[ptr + 3], length);
1406 res = __ws_segment_to_service(segment, &new_service);
1408 WDP_LOGE("Failed to convert segment as service instance");
1413 services = g_list_append(services, new_service);
1419 data->edata_type = WFD_OEM_EDATA_TYPE_NEW_SERVICE;
1420 data->dev_role = count;
1421 data->edata = (void*) services;
1425 void __ws_extract_servicediscoveryresponse_details(const char *key, GVariant *value, void *user_data)
1427 __WDP_LOG_FUNC_ENTER__;
1428 wfd_oem_event_s *event = (wfd_oem_event_s *)user_data;
1433 CHECK_KEY_VALUE(key, value);
1435 if (g_strcmp0(key, "peer_object") == 0) {
1436 static unsigned char peer_dev[WS_MACSTR_LEN] = {'\0',};
1437 const char *path = NULL;
1440 g_variant_get(value, "&o", &path);
1444 WDP_LOGD("Retrive Added path [%s]", path);
1445 loc = strrchr(path, '/');
1447 __ws_mac_compact_to_normal(loc + 1, peer_dev);
1448 __ws_txt_to_mac(peer_dev, event->dev_addr);
1450 } else if (g_strcmp0(key, "update_indicator") == 0) {
1452 } else if (g_strcmp0(key, "tlvs") == 0) {
1453 GVariantIter *iter = NULL;
1454 unsigned char service_hex[WS_MAX_SERVICE_LEN];
1455 int byte_length = 0;
1457 g_variant_get(value, "ay", &iter);
1459 WDP_LOGE("failed to get iterator");
1463 memset(service_hex, 0x0, WS_MAX_SERVICE_LEN);
1464 while (g_variant_iter_loop(iter, "y", &service_hex[byte_length]))
1466 g_variant_iter_free(iter);
1468 __ws_extract_peer_service(event, service_hex, byte_length);
1471 __WDP_LOG_FUNC_EXIT__;
1474 static void __ws_extract_serviceaspresponse_details(const char *key, GVariant *value, void *user_data)
1476 __WDP_LOG_FUNC_ENTER__;
1477 wfd_oem_event_s *event = (wfd_oem_event_s *)user_data;
1478 if (!event || !event->edata)
1481 wfd_oem_asp_service_s *service = (wfd_oem_asp_service_s *)event->edata;
1483 if (g_strcmp0(key, "peer_object") == 0) {
1484 static unsigned char peer_dev[WS_MACSTR_LEN] = {'\0',};
1485 const char *path = NULL;
1488 g_variant_get(value, "&o", &path);
1492 WDP_LOGD("Retrive Added path [%s]", path);
1493 loc = strrchr(path, '/');
1495 __ws_mac_compact_to_normal(loc + 1, peer_dev);
1496 __ws_txt_to_mac(peer_dev, event->dev_addr);
1498 } else if (g_strcmp0(key, "srv_trans_id") == 0) {
1499 unsigned int srv_trans_id = 0;
1500 g_variant_get(value, "u", &srv_trans_id);
1501 service->tran_id = srv_trans_id;
1502 WDP_LOGD("Retrive srv_trans_id [%x]", service->tran_id);
1504 } else if (g_strcmp0(key, "adv_id") == 0) {
1505 unsigned int adv_id = 0;
1506 g_variant_get(value, "u", &adv_id);
1507 service->adv_id = adv_id;
1508 WDP_LOGD("Retrive adv_id [%x]", service->adv_id);
1510 } else if (g_strcmp0(key, "svc_status") == 0) {
1511 unsigned char svc_status = 0;
1512 g_variant_get(value, "u", &svc_status);
1513 service->status = svc_status;
1514 WDP_LOGD("Retrive svc_status [%x]", service->status);
1516 } else if (g_strcmp0(key, "config_methods") == 0) {
1517 unsigned int config_methods = 0;
1518 g_variant_get(value, "q", &config_methods);
1519 service->config_method = config_methods;
1520 WDP_LOGD("Retrive config_methods [%x]", service->config_method);
1522 } else if (g_strcmp0(key, "svc_str") == 0) {
1523 const char *svc_str = NULL;
1524 g_variant_get(value, "&s", &svc_str);
1525 if (svc_str != NULL)
1526 service->service_type = g_strdup(svc_str);
1527 WDP_LOGD("Retrive srv_name [%s]", service->service_type);
1529 } else if (g_strcmp0(key, "info") == 0) {
1530 const char *info = NULL;
1531 g_variant_get(value, "&s", &info);
1533 service->service_info = g_strdup(info);
1534 WDP_LOGD("Retrive srv_info [%s]", service->service_info);
1536 __WDP_LOG_FUNC_EXIT__;
1539 static void __ws_extract_asp_provision_start_details(const char *key, GVariant *value, void *user_data)
1541 __WDP_LOG_FUNC_ENTER__;
1542 wfd_oem_event_s *event = (wfd_oem_event_s *)user_data;
1543 wfd_oem_asp_prov_s *asp_params = NULL;
1544 if (!event || !event->edata) {
1545 __WDP_LOG_FUNC_EXIT__;
1549 asp_params = (wfd_oem_asp_prov_s *)event->edata;
1551 if (g_strcmp0(key, "peer_object") == 0) {
1552 static unsigned char peer_dev[WS_MACSTR_LEN] = {'\0',};
1553 const char *path = NULL;
1556 g_variant_get(value, "&o", &path);
1558 __WDP_LOG_FUNC_EXIT__;
1562 WDP_LOGD("Retrive Added path [%s]", path);
1563 loc = strrchr(path, '/');
1565 __ws_mac_compact_to_normal(loc + 1, peer_dev);
1566 __ws_txt_to_mac(peer_dev, event->dev_addr);
1568 } else if (g_strcmp0(key, "adv_id") == 0) {
1569 g_variant_get(value, "u", &asp_params->adv_id);
1570 WDP_LOGD("Retrive adv_id [%u]", asp_params->adv_id);
1572 } else if (g_strcmp0(key, "ses_id") == 0) {
1573 g_variant_get(value, "u", &asp_params->session_id);
1574 WDP_LOGD("Retrive session id [%u]", asp_params->session_id);
1576 } else if (g_strcmp0(key, "dev_passwd_id") == 0) {
1577 g_variant_get(value, "i", &event->wps_mode);
1578 WDP_LOGD("Retrive dev_passwd_id [%d]", event->wps_mode);
1580 } else if (g_strcmp0(key, "conncap") == 0) {
1581 g_variant_get(value, "u", &asp_params->network_role);
1582 WDP_LOGD("Retrive conncap [%x]", asp_params->network_role);
1584 } else if (g_strcmp0(key, "adv_mac") == 0) {
1585 if (__ws_unpack_ay(asp_params->service_mac, value, WS_MACADDR_LEN))
1586 WDP_LOGD("Adv address[" MACSTR "]", MAC2STR(asp_params->service_mac));
1588 } else if (g_strcmp0(key, "ses_mac") == 0) {
1589 if (__ws_unpack_ay(asp_params->session_mac, value, WS_MACADDR_LEN))
1590 WDP_LOGD("session address[" MACSTR "]", MAC2STR(asp_params->session_mac));
1592 } else if (g_strcmp0(key, "session_info") == 0) {
1593 const char *session_info = NULL;
1594 g_variant_get(value, "&s", &session_info);
1595 if (session_info != NULL)
1596 asp_params->session_information = g_strdup(session_info);
1597 WDP_LOGD("Retrive session_info [%s]", asp_params->session_information);
1599 __WDP_LOG_FUNC_EXIT__;
1602 static void __ws_extract_asp_provision_done_details(const char *key, GVariant *value, void *user_data)
1604 __WDP_LOG_FUNC_ENTER__;
1605 wfd_oem_event_s *event = (wfd_oem_event_s *)user_data;
1606 wfd_oem_asp_prov_s *asp_params = NULL;
1607 if (!event || !event->edata) {
1608 __WDP_LOG_FUNC_EXIT__;
1612 asp_params = (wfd_oem_asp_prov_s *)event->edata;
1615 if (g_strcmp0(key, "peer_object") == 0) {
1616 static unsigned char peer_dev[WS_MACSTR_LEN] = {'\0',};
1617 const char *path = NULL;
1620 g_variant_get(value, "&o", &path);
1622 __WDP_LOG_FUNC_EXIT__;
1626 WDP_LOGD("Retrive Added path [%s]", path);
1627 loc = strrchr(path, '/');
1629 __ws_mac_compact_to_normal(loc + 1, peer_dev);
1630 __ws_txt_to_mac(peer_dev, event->dev_addr);
1632 WDP_LOGD("peer address[" MACSTR "]", MAC2STR(event->dev_addr));
1634 } else if (g_strcmp0(key, "adv_id") == 0) {
1635 g_variant_get(value, "u", &asp_params->adv_id);
1636 WDP_LOGD("Retrive adv_id [%u]", asp_params->adv_id);
1638 } else if (g_strcmp0(key, "ses_id") == 0) {
1639 g_variant_get(value, "u", &asp_params->session_id);
1640 WDP_LOGD("Retrive session id [%u]", asp_params->session_id);
1642 } else if (g_strcmp0(key, "dev_passwd_id") == 0) {
1643 g_variant_get(value, "i", &event->wps_mode);
1644 WDP_LOGD("Retrive dev_passwd_id [%d]", event->wps_mode);
1646 } else if (g_strcmp0(key, "conncap") == 0) {
1647 g_variant_get(value, "u", &asp_params->network_role);
1648 WDP_LOGD("Retrive network role [%x]", asp_params->network_role);
1650 } else if (g_strcmp0(key, "status") == 0) {
1651 g_variant_get(value, "u", &asp_params->status);
1652 WDP_LOGD("Retrive status [%x]", asp_params->status);
1654 } else if (g_strcmp0(key, "persist") == 0) {
1655 g_variant_get(value, "u", &asp_params->persistent_group_id);
1656 asp_params->persist = 1;
1657 WDP_LOGD("Retrive persist [%u]", asp_params->persistent_group_id);
1659 } else if (g_strcmp0(key, "adv_mac") == 0) {
1660 if (__ws_unpack_ay(asp_params->service_mac, value, WS_MACADDR_LEN))
1661 WDP_LOGD("Adv address[" MACSTR "]", MAC2STR(asp_params->service_mac));
1663 } else if (g_strcmp0(key, "ses_mac") == 0) {
1664 if (__ws_unpack_ay(asp_params->session_mac, value, WS_MACADDR_LEN))
1665 WDP_LOGD("session address[" MACSTR "]", MAC2STR(asp_params->session_mac));
1667 } else if (g_strcmp0(key, "group_mac") == 0) {
1668 if (__ws_unpack_ay(asp_params->group_mac, value, WS_MACADDR_LEN))
1669 WDP_LOGD("group address[" MACSTR "]", MAC2STR(asp_params->group_mac));
1671 __WDP_LOG_FUNC_EXIT__;
1674 static void __ws_extract_provision_fail_details(const char *key, GVariant *value, void *user_data)
1676 __WDP_LOG_FUNC_ENTER__;
1677 wfd_oem_event_s *event = (wfd_oem_event_s *)user_data;
1678 wfd_oem_asp_prov_s *asp_params = NULL;
1679 if (!event || !event->edata) {
1680 __WDP_LOG_FUNC_EXIT__;
1684 asp_params = (wfd_oem_asp_prov_s *)event->edata;
1686 if (g_strcmp0(key, "peer_object") == 0) {
1687 static unsigned char peer_dev[WS_MACSTR_LEN] = {'\0',};
1688 const char *path = NULL;
1691 g_variant_get(value, "&o", &path);
1693 __WDP_LOG_FUNC_EXIT__;
1697 WDP_LOGD("Retrive Added path [%s]", path);
1698 loc = strrchr(path, '/');
1700 __ws_mac_compact_to_normal(loc + 1, peer_dev);
1701 __ws_txt_to_mac(peer_dev, event->dev_addr);
1703 } else if (g_strcmp0(key, "adv_id") == 0) {
1704 g_variant_get(value, "u", &asp_params->adv_id);
1705 WDP_LOGD("Retrive adv_id [%d]", asp_params->adv_id);
1707 } else if (g_strcmp0(key, "status") == 0) {
1708 g_variant_get(value, "i", &asp_params->status);
1709 WDP_LOGD("Retrive status [%d]", asp_params->status);
1711 } else if (g_strcmp0(key, "deferred_session_resp") == 0) {
1712 const char *session_info = NULL;
1713 g_variant_get(value, "&s", &session_info);
1714 if (session_info != NULL)
1715 asp_params->session_information = g_strdup(session_info);
1716 WDP_LOGD("Retrive deferred_session_resp [%s]", asp_params->session_information);
1718 __WDP_LOG_FUNC_EXIT__;
1721 static int _ws_flush(void)
1723 __WDP_LOG_FUNC_ENTER__;
1724 GDBusConnection *g_dbus = NULL;
1725 dbus_method_param_s params;
1729 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
1730 __WDP_LOG_FUNC_EXIT__;
1734 g_dbus = g_pd->g_dbus;
1736 WDP_LOGE("DBus connection is NULL");
1737 __WDP_LOG_FUNC_EXIT__;
1740 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
1742 dbus_set_method_param(¶ms, "Flush", g_pd->iface_path, g_dbus);
1743 params.params = NULL;
1745 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
1747 WDP_LOGE("Failed to send command to wpa_supplicant");
1749 WDP_LOGD("Succeeded to flush");
1751 __WDP_LOG_FUNC_EXIT__;
1755 static int _ws_cancel(void)
1757 __WDP_LOG_FUNC_ENTER__;
1758 GDBusConnection *g_dbus = NULL;
1759 dbus_method_param_s params;
1763 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
1764 __WDP_LOG_FUNC_EXIT__;
1769 g_dbus = g_pd->g_dbus;
1771 WDP_LOGE("DBus connection is NULL");
1772 __WDP_LOG_FUNC_EXIT__;
1775 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
1777 dbus_set_method_param(¶ms, "Cancel", g_pd->iface_path , g_dbus);
1778 params.params = NULL;
1780 res = dbus_method_call(¶ms, SUPPLICANT_WPS, NULL, NULL);
1782 WDP_LOGE("Failed to send command to wpa_supplicant");
1784 WDP_LOGD("Succeeded to cancel");
1786 __WDP_LOG_FUNC_EXIT__;
1790 int ws_get_advertise_service(const char *peer_path, GList **asp_services)
1792 __WDP_LOG_FUNC_ENTER__;
1793 GDBusConnection *g_dbus = NULL;
1794 GVariant *param = NULL;
1795 GVariant *reply = NULL;
1796 GVariant *temp1 = NULL;
1797 GVariant *temp2 = NULL;
1798 GError *error = NULL;
1799 GVariantIter *iter = NULL;
1800 wfd_oem_advertise_service_s *service;
1801 wfd_oem_asp_service_s *seek = NULL;
1802 unsigned char desc[7];
1803 unsigned int adv_id;
1804 unsigned int config_method;
1805 unsigned char length;
1811 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
1815 g_dbus = g_pd->g_dbus;
1817 WDP_LOGE("DBus connection is NULL");
1821 param = g_variant_new("(ss)", SUPPLICANT_P2P_PEER, "AdvertiseService");
1822 DEBUG_G_VARIANT("Params : ", param);
1824 reply = g_dbus_connection_call_sync(
1826 SUPPLICANT_SERVICE, /* bus name */
1827 peer_path, /* object path */
1828 DBUS_PROPERTIES_INTERFACE, /* interface name */
1829 DBUS_PROPERTIES_METHOD_GET, /* method name */
1830 param, /* GVariant *params */
1831 NULL, /* reply_type */
1832 G_DBUS_CALL_FLAGS_NONE, /* flags */
1833 SUPPLICANT_TIMEOUT , /* timeout */
1834 NULL, /* cancellable */
1835 &error); /* error */
1837 if (error != NULL) {
1838 WDP_LOGE("Error! Failed to get peer advertise service: [%s]",
1840 g_error_free(error);
1842 g_variant_unref(reply);
1843 __WDP_LOG_FUNC_EXIT__;
1847 if (reply != NULL) {
1848 DEBUG_G_VARIANT("Reply : ", reply);
1850 /* replay will have the format <(<ay>,)>
1851 * So, you need to remove tuple out side of variant and
1852 * variant out side of byte array
1854 temp1 = g_variant_get_child_value(reply, 0);
1855 temp2 = g_variant_get_child_value(temp1, 0);
1856 g_variant_get(temp2, "ay", &iter);
1858 g_variant_unref(reply);
1859 WDP_LOGE("Failed to get iterator");
1862 g_variant_unref(temp2);
1863 g_variant_unref(temp1);
1866 /* 4byte advertisement ID, 2 byte config method, 1byte length */
1869 memset(desc, 0x0, 7);
1870 while (cnt < 7 && g_variant_iter_loop(iter, "y", &desc[cnt]))
1873 if (cnt != 7 || desc[6] == 0) {
1874 WDP_LOGE("Invalid descriptor header length cnt [%d]", cnt);
1875 g_variant_unref(reply);
1879 adv_id = desc[3] << 24 | desc[2] << 16 | desc[1] << 8 | desc[0];
1880 config_method = desc[4] << 8 | desc[4];
1883 value = g_try_malloc0(length + 1);
1884 if (value == NULL) {
1885 WDP_LOGE("g_try_malloc0 failed");
1886 g_variant_unref(reply);
1889 WDP_LOGD("adv_id[%u] config_method[%u] length[%hhu]", adv_id, config_method, length);
1892 while (cnt < length && g_variant_iter_loop(iter, "y", &value[cnt]))
1895 if (cnt != length) {
1896 WDP_LOGE("Length doesn't matched with header value cnt [%d]", cnt);
1897 g_variant_unref(reply);
1903 service = (wfd_oem_advertise_service_s *)
1904 g_try_malloc0(sizeof(wfd_oem_advertise_service_s));
1905 if (service == NULL) {
1906 WDP_LOGE("g_try_malloc0 failed");
1907 g_variant_unref(reply);
1911 service->adv_id = adv_id;
1912 service->config_method = config_method;
1913 service->service_type_length = length;
1914 service->service_type = value;
1916 GLIST_ITER_START(seek_list, seek)
1917 if (g_strcmp0(seek->service_type, service->service_type) == 0) {
1918 WDP_LOGD("service type matched [%s] search_id [%llu]",
1919 service->service_type, seek->search_id);
1925 if (seek != NULL && seek->service_info != NULL) {
1926 WDP_LOGD("service info exists, service discovery will be performed");
1928 WDP_LOGD("service info doesn't exists. Add service to list");
1930 service->search_id = seek->search_id;
1931 *asp_services = g_list_append(*asp_services, service);
1934 g_variant_unref(reply);
1936 __WDP_LOG_FUNC_EXIT__;
1941 int ws_get_advertise_asp_service(const char *peer_path, GList **asp_services)
1943 __WDP_LOG_FUNC_ENTER__;
1944 GDBusConnection *g_dbus = NULL;
1945 GVariant *param = NULL;
1946 GVariant *reply = NULL;
1947 GVariant *temp1 = NULL;
1948 GVariant *temp2 = NULL;
1949 GError *error = NULL;
1950 GVariantIter *iter = NULL;
1951 wfd_oem_advertise_service_s *service;
1952 wfd_oem_asp_service_s *seek = NULL;
1953 unsigned char desc[7];
1954 unsigned int adv_id;
1955 unsigned int config_method;
1956 unsigned char length;
1957 char *service_type = NULL;
1958 char *instance_name = NULL;
1959 unsigned char instance_length = 0;
1964 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
1968 g_dbus = g_pd->g_dbus;
1970 WDP_LOGE("DBus connection is NULL");
1974 param = g_variant_new("(ss)", SUPPLICANT_P2P_PEER, "AdvertiseASPService");
1975 DEBUG_G_VARIANT("Params : ", param);
1977 reply = g_dbus_connection_call_sync(
1979 SUPPLICANT_SERVICE, /* bus name */
1980 peer_path, /* object path */
1981 DBUS_PROPERTIES_INTERFACE, /* interface name */
1982 DBUS_PROPERTIES_METHOD_GET, /* method name */
1983 param, /* GVariant *params */
1984 NULL, /* reply_type */
1985 G_DBUS_CALL_FLAGS_NONE, /* flags */
1986 SUPPLICANT_TIMEOUT , /* timeout */
1987 NULL, /* cancellable */
1988 &error); /* error */
1990 if (error != NULL) {
1991 WDP_LOGE("Error! Failed to get peer advertise service: [%s]",
1993 g_error_free(error);
1995 g_variant_unref(reply);
1996 __WDP_LOG_FUNC_EXIT__;
2000 if (reply != NULL) {
2001 DEBUG_G_VARIANT("Reply : ", reply);
2003 /* replay will have the format <(<ay>,)>
2004 * So, you need to remove tuple out side of variant and
2005 * variant out side of byte array
2007 temp1 = g_variant_get_child_value(reply, 0);
2008 temp2 = g_variant_get_child_value(temp1, 0);
2009 g_variant_get(temp2, "ay", &iter);
2011 g_variant_unref(reply);
2012 WDP_LOGE("Failed to get iterator");
2015 g_variant_unref(temp2);
2016 g_variant_unref(temp1);
2019 /* 4byte advertisement ID, 2 byte config method, 1byte length */
2022 memset(desc, 0x0, 7);
2023 while (cnt < 7 && g_variant_iter_loop(iter, "y", &desc[cnt]))
2026 if (cnt != 7 || desc[6] == 0) {
2027 WDP_LOGE("Invalid descriptor header length cnt [%d]", cnt);
2028 g_variant_unref(reply);
2032 adv_id = desc[3] << 24 | desc[2] << 16 | desc[1] << 8 | desc[0];
2033 config_method = desc[4] << 8 | desc[4];
2035 service_type = g_try_malloc0(length + 1);
2036 if (service_type == NULL) {
2037 WDP_LOGE("g_try_malloc0 failed");
2038 g_variant_unref(reply);
2041 WDP_LOGD("adv_id[%u] config_method[%u] length[%hhu]", adv_id, config_method, length);
2044 while (cnt < length + 1 && g_variant_iter_loop(iter, "y", &service_type[cnt]))
2047 if (cnt != length + 1) {
2048 WDP_LOGE("Length doesn't matched with header value cnt [%d]", cnt);
2049 g_variant_unref(reply);
2050 g_free(service_type);
2054 instance_length = (unsigned char)service_type[length];
2055 service_type[length] = '\0';
2057 if (instance_length != 0) {
2058 instance_name = g_try_malloc0(instance_length + 1);
2059 if (instance_name == NULL) {
2060 WDP_LOGE("g_try_malloc0 failed");
2061 g_variant_unref(reply);
2062 g_free(service_type);
2065 WDP_LOGD("instnace name length[%hhu]", instance_length);
2068 while (cnt < instance_length && g_variant_iter_loop(iter, "y", &instance_name[cnt]))
2071 if (cnt != instance_length) {
2072 WDP_LOGE("Length doesn't matched with header value cnt [%d]", cnt);
2073 g_variant_unref(reply);
2074 g_free(service_type);
2075 g_free(instance_name);
2081 service = (wfd_oem_advertise_service_s *)
2082 g_try_malloc0(sizeof(wfd_oem_advertise_service_s));
2083 if (service == NULL) {
2084 WDP_LOGE("g_try_malloc0 failed");
2085 g_variant_unref(reply);
2086 g_free(service_type);
2087 g_free(instance_name);
2090 service->adv_id = adv_id;
2091 service->config_method = config_method;
2092 service->service_type_length = length;
2093 service->service_type = service_type;
2094 service->instance_name_length = instance_length;
2095 service->instance_name = instance_name;
2097 GLIST_ITER_START(seek_list, seek)
2098 if (g_strcmp0(seek->service_type, service->service_type) == 0) {
2099 /* TODO: We need to support for instance name also hear */
2100 WDP_LOGD("service type matched [%s] search_id [%llu]",
2101 service->service_type, seek->search_id);
2107 if (seek != NULL && seek->service_info != NULL) {
2108 WDP_LOGD("service info exists, service discovery will be performed");
2110 WDP_LOGD("service info doesn't exists. Add service to list");
2112 service->search_id = seek->search_id;
2113 *asp_services = g_list_append(*asp_services, service);
2116 g_variant_unref(reply);
2118 __WDP_LOG_FUNC_EXIT__;
2122 static void _ws_process_device_found_properties(GDBusConnection *connection,
2123 const gchar *sender, const gchar *object_path, const gchar *interface,
2124 const gchar *signal, GVariant *parameters, gpointer user_data)
2126 __WDP_LOG_FUNC_ENTER__;
2127 wfd_oem_event_s event;
2128 wfd_oem_dev_data_s *dev_data = NULL;
2129 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
2130 GVariantIter *iter = NULL;
2131 const char *path = NULL;
2133 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2135 if (!__is_valid_plugin())
2138 dev_data = __create_dev_data();
2140 __WDP_LOG_FUNC_EXIT__;
2144 __set_event_data(WFD_OEM_EVENT_PEER_FOUND,
2145 WFD_OEM_EDATA_TYPE_DEVICE,
2149 g_variant_get(parameters, "(&oa{sv})", &path, &iter);
2150 g_strlcpy(peer_path, path, DBUS_OBJECT_PATH_MAX);
2151 WDP_LOGD("Retrive Added path [%s]", peer_path);
2153 __extract_addr_from_path(peer_path, event.dev_addr);
2157 GVariant *value = NULL;
2159 while (g_variant_iter_loop(iter, "{sv}", &key, &value)) {
2160 CHECK_KEY_VALUE(key, value);
2162 __ws_peer_property(key, value, (void *)event.edata);
2164 g_variant_iter_free(iter);
2167 if (dev_data->p2p_dev_addr[0] == 0x0)
2168 memcpy(dev_data->p2p_dev_addr, event.dev_addr, OEM_MACADDR_LEN);
2170 if (dev_data->has_asp_services)
2171 ws_get_advertise_service(peer_path, (GList **)&(event.asp_services));
2172 if (dev_data->has_asp2_services)
2173 ws_get_advertise_asp_service(peer_path, (GList **)&(event.asp2_services));
2175 if (g_pd->callback->peer_found_cb)
2176 g_pd->callback->peer_found_cb(&event);
2178 if (event.asp_services != NULL) {
2180 wfd_oem_advertise_service_s *service;
2181 for (l = (GList *)event.asp_services; l != NULL; l = l->next) {
2182 service = (wfd_oem_advertise_service_s *)l->data;
2183 event.asp_services = g_list_remove(l, service);
2184 g_free(service->service_type);
2188 if (event.asp2_services != NULL) {
2190 wfd_oem_advertise_service_s *service;
2191 for (l = (GList *)event.asp2_services; l != NULL; l = l->next) {
2192 service = (wfd_oem_advertise_service_s *)l->data;
2193 event.asp_services = g_list_remove(l, service);
2194 g_free(service->service_type);
2195 g_free(service->instance_name);
2200 __destroy_dev_data(dev_data);
2202 __WDP_LOG_FUNC_EXIT__;
2205 static void _ws_process_device_lost(GDBusConnection *connection,
2206 const gchar *sender, const gchar *object_path, const gchar *interface,
2207 const gchar *signal, GVariant *parameters, gpointer user_data)
2209 __WDP_LOG_FUNC_ENTER__;
2210 wfd_oem_event_s event;
2211 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
2213 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2215 if (!g_pd || !g_pd->callback) {
2216 WDP_LOGD("Ignoring event");
2217 __WDP_LOG_FUNC_EXIT__;
2221 memset(&event, 0x0, sizeof(wfd_oem_event_s));
2223 event.edata_type = WFD_OEM_EDATA_TYPE_NONE;
2224 event.event_id = WFD_OEM_EVENT_PEER_DISAPPEARED;
2226 __ws_path_to_addr(peer_path, event.dev_addr, parameters);
2228 if (g_pd->callback->peer_disappeared_cb)
2229 g_pd->callback->peer_disappeared_cb(&event);
2232 __WDP_LOG_FUNC_EXIT__;
2235 static void _ws_process_find_stoppped(GDBusConnection *connection,
2236 const gchar *sender, const gchar *object_path, const gchar *interface,
2237 const gchar *signal, GVariant *parameters, gpointer user_data)
2239 __WDP_LOG_FUNC_ENTER__;
2240 wfd_oem_event_s event;
2242 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2244 if (!g_pd || !g_pd->callback) {
2245 WDP_LOGD("Ignoring event");
2246 __WDP_LOG_FUNC_EXIT__;
2250 memset(&event, 0x0, sizeof(wfd_oem_event_s));
2252 event.edata_type = WFD_OEM_EDATA_TYPE_NONE;
2253 event.event_id = WFD_OEM_EVENT_DISCOVERY_FINISHED;
2255 if (g_pd->callback->discovery_finished_cb)
2256 g_pd->callback->discovery_finished_cb(&event);
2258 __WDP_LOG_FUNC_EXIT__;
2261 static void _ws_process_prov_disc_req_display_pin(GDBusConnection *connection,
2262 const gchar *sender, const gchar *object_path, const gchar *interface,
2263 const gchar *signal, GVariant *parameters, gpointer user_data)
2265 __WDP_LOG_FUNC_ENTER__;
2266 wfd_oem_event_s event;
2267 wfd_oem_dev_data_s *dev_data = NULL;
2268 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
2269 const char *path = NULL;
2270 const char *pin = NULL;
2271 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2273 if (!__is_valid_plugin())
2276 dev_data = __create_dev_data();
2278 __WDP_LOG_FUNC_EXIT__;
2282 __set_event_data(WFD_OEM_EVENT_PROV_DISC_REQ,
2283 WFD_OEM_EDATA_TYPE_DEVICE,
2286 event.wps_mode = WFD_OEM_WPS_MODE_DISPLAY;
2288 g_variant_get(parameters, "(&o&s)", &path, &pin);
2289 g_strlcpy(peer_path, path, DBUS_OBJECT_PATH_MAX);
2290 WDP_LOGD("Retrive Added path [%s]", peer_path);
2292 __extract_addr_from_path(peer_path, event.dev_addr);
2294 g_strlcpy(event.wps_pin, pin, WS_PINSTR_LEN + 1);
2295 WDP_LOGD("Retrive pin [%s]", event.wps_pin);
2297 dbus_property_get_all(peer_path, g_pd->g_dbus, SUPPLICANT_P2P_PEER,
2298 __ws_peer_property, event.edata);
2300 if (g_pd->callback->prov_disc_req_cb)
2301 g_pd->callback->prov_disc_req_cb(&event);
2303 __destroy_dev_data(dev_data);
2305 __WDP_LOG_FUNC_EXIT__;
2308 static void _ws_process_prov_disc_resp_display_pin(GDBusConnection *connection,
2309 const gchar *sender, const gchar *object_path, const gchar *interface,
2310 const gchar *signal, GVariant *parameters, gpointer user_data)
2312 __WDP_LOG_FUNC_ENTER__;
2313 wfd_oem_event_s event;
2314 wfd_oem_dev_data_s *dev_data = NULL;
2315 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
2316 const char *path = NULL;
2317 const char *pin = NULL;
2319 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2321 if (!__is_valid_plugin())
2324 dev_data = __create_dev_data();
2326 __WDP_LOG_FUNC_EXIT__;
2330 __set_event_data(WFD_OEM_EVENT_PROV_DISC_RESP,
2331 WFD_OEM_EDATA_TYPE_DEVICE,
2334 event.wps_mode = WFD_OEM_WPS_MODE_DISPLAY;
2336 g_variant_get(parameters, "(&o&s)", &path, &pin);
2337 g_strlcpy(peer_path, path, DBUS_OBJECT_PATH_MAX);
2338 WDP_LOGD("Retrive Added path [%s]", peer_path);
2340 __extract_addr_from_path(peer_path, event.dev_addr);
2342 g_strlcpy(event.wps_pin, pin, WS_PINSTR_LEN + 1);
2343 WDP_LOGD("Retrive pin [%s]", event.wps_pin);
2345 dbus_property_get_all(peer_path, g_pd->g_dbus, SUPPLICANT_P2P_PEER,
2346 __ws_peer_property, event.edata);
2348 if (g_pd->callback->prov_disc_resp_cb)
2349 g_pd->callback->prov_disc_resp_cb(&event);
2351 __destroy_dev_data(dev_data);
2353 __WDP_LOG_FUNC_EXIT__;
2356 static void _ws_process_prov_disc_req_enter_pin(GDBusConnection *connection,
2357 const gchar *sender, const gchar *object_path, const gchar *interface,
2358 const gchar *signal, GVariant *parameters, gpointer user_data)
2360 __WDP_LOG_FUNC_ENTER__;
2361 wfd_oem_event_s event;
2362 wfd_oem_dev_data_s *dev_data = NULL;
2363 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
2365 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2366 if (!__is_valid_plugin())
2369 dev_data = __create_dev_data();
2371 __WDP_LOG_FUNC_EXIT__;
2375 __set_event_data(WFD_OEM_EVENT_PROV_DISC_REQ,
2376 WFD_OEM_EDATA_TYPE_DEVICE,
2379 event.wps_mode = WFD_OEM_WPS_MODE_KEYPAD;
2381 __ws_path_to_addr(peer_path, event.dev_addr, parameters);
2383 dbus_property_get_all(peer_path, g_pd->g_dbus, SUPPLICANT_P2P_PEER,
2384 __ws_peer_property, event.edata);
2386 if (g_pd->callback->prov_disc_req_cb)
2387 g_pd->callback->prov_disc_req_cb(&event);
2389 __destroy_dev_data(dev_data);
2391 __WDP_LOG_FUNC_EXIT__;
2394 static void _ws_process_prov_disc_resp_enter_pin(GDBusConnection *connection,
2395 const gchar *sender, const gchar *object_path, const gchar *interface,
2396 const gchar *signal, GVariant *parameters, gpointer user_data)
2398 __WDP_LOG_FUNC_ENTER__;
2399 wfd_oem_event_s event;
2400 wfd_oem_dev_data_s *dev_data = NULL;
2401 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
2403 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2405 if (!__is_valid_plugin())
2408 dev_data = __create_dev_data();
2410 __WDP_LOG_FUNC_EXIT__;
2414 __set_event_data(WFD_OEM_EVENT_PROV_DISC_RESP,
2415 WFD_OEM_EDATA_TYPE_DEVICE,
2419 event.wps_mode = WFD_OEM_WPS_MODE_KEYPAD;
2421 __ws_path_to_addr(peer_path, event.dev_addr, parameters);
2423 dbus_property_get_all(peer_path, g_pd->g_dbus, SUPPLICANT_P2P_PEER,
2424 __ws_peer_property, event.edata);
2426 if (g_pd->callback->prov_disc_resp_cb)
2427 g_pd->callback->prov_disc_resp_cb(&event);
2429 __destroy_dev_data(dev_data);
2431 __WDP_LOG_FUNC_EXIT__;
2434 static void _ws_process_prov_disc_pbc_req(GDBusConnection *connection,
2435 const gchar *sender, const gchar *object_path, const gchar *interface,
2436 const gchar *signal, GVariant *parameters, gpointer user_data)
2438 __WDP_LOG_FUNC_ENTER__;
2439 wfd_oem_event_s event;
2440 wfd_oem_dev_data_s *dev_data = NULL;
2441 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
2443 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2445 if (!__is_valid_plugin())
2448 dev_data = __create_dev_data();
2450 __WDP_LOG_FUNC_EXIT__;
2453 __set_event_data(WFD_OEM_EVENT_PROV_DISC_REQ,
2454 WFD_OEM_EDATA_TYPE_DEVICE,
2457 event.wps_mode = WFD_OEM_WPS_MODE_PBC;
2459 __ws_path_to_addr(peer_path, event.dev_addr, parameters);
2461 dbus_property_get_all(peer_path, g_pd->g_dbus, SUPPLICANT_P2P_PEER,
2462 __ws_peer_property, event.edata);
2464 if (g_pd->callback->prov_disc_req_cb)
2465 g_pd->callback->prov_disc_req_cb(&event);
2467 __destroy_dev_data(dev_data);
2469 __WDP_LOG_FUNC_EXIT__;
2472 static void _ws_process_prov_disc_pbc_resp(GDBusConnection *connection,
2473 const gchar *sender, const gchar *object_path, const gchar *interface,
2474 const gchar *signal, GVariant *parameters, gpointer user_data)
2476 __WDP_LOG_FUNC_ENTER__;
2477 wfd_oem_event_s event;
2478 wfd_oem_dev_data_s *dev_data = NULL;
2479 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
2481 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2483 if (!__is_valid_plugin())
2486 dev_data = __create_dev_data();
2488 __WDP_LOG_FUNC_EXIT__;
2491 __set_event_data(WFD_OEM_EVENT_PROV_DISC_RESP,
2492 WFD_OEM_EDATA_TYPE_DEVICE,
2495 event.wps_mode = WFD_OEM_WPS_MODE_PBC;
2497 __ws_path_to_addr(peer_path, event.dev_addr, parameters);
2499 dbus_property_get_all(peer_path, g_pd->g_dbus, SUPPLICANT_P2P_PEER,
2500 __ws_peer_property, event.edata);
2502 if (g_pd->callback->prov_disc_resp_cb)
2503 g_pd->callback->prov_disc_resp_cb(&event);
2505 __destroy_dev_data(dev_data);
2507 __WDP_LOG_FUNC_EXIT__;
2510 static void _ws_process_prov_disc_failure(GDBusConnection *connection,
2511 const gchar *sender, const gchar *object_path, const gchar *interface,
2512 const gchar *signal, GVariant *parameters, gpointer user_data)
2514 __WDP_LOG_FUNC_ENTER__;
2515 GVariantIter *iter = NULL;
2516 wfd_oem_event_s event;
2517 wfd_oem_asp_prov_s *edata;
2519 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2521 if (!g_pd || !g_pd->callback) {
2522 WDP_LOGD("Ignoring event");
2523 __WDP_LOG_FUNC_EXIT__;
2527 edata = (wfd_oem_asp_prov_s *) g_try_malloc0(sizeof(wfd_oem_asp_prov_s));
2529 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
2530 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
2531 WDP_LOGF("Failed to allocate memory for event. [%s]",
2533 __WDP_LOG_FUNC_EXIT__;
2536 memset(&event, 0x0, sizeof(wfd_oem_event_s));
2538 event.edata = (void*) edata;
2539 event.event_id = WFD_OEM_EVENT_PROV_DISC_FAIL;
2541 if (parameters != NULL) {
2542 g_variant_get(parameters, "(a{sv})", &iter);
2544 dbus_property_foreach(iter, __ws_extract_provision_fail_details, &event);
2545 event.edata_type = WFD_OEM_EDATA_TYPE_ASP_PROV;
2546 g_variant_iter_free(iter);
2549 WDP_LOGE("No Properties");
2552 if (g_pd->callback->prov_disc_fail_cb)
2553 g_pd->callback->prov_disc_fail_cb(&event);
2555 if (event.edata_type == WFD_OEM_EDATA_TYPE_ASP_PROV)
2556 g_free(edata->session_information);
2559 __WDP_LOG_FUNC_EXIT__;
2562 static void _ws_process_group_started(GDBusConnection *connection,
2563 const gchar *sender, const gchar *object_path, const gchar *interface,
2564 const gchar *signal, GVariant *parameters, gpointer user_data)
2566 __WDP_LOG_FUNC_ENTER__;
2567 GVariantIter *iter = NULL;
2568 wfd_oem_event_s event;
2569 wfd_oem_group_data_s *edata = NULL;
2571 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2573 if (!g_pd || !g_pd->callback) {
2574 WDP_LOGD("Ignoring event");
2575 __WDP_LOG_FUNC_EXIT__;
2579 edata = (wfd_oem_group_data_s*)calloc(1, sizeof(wfd_oem_group_data_s));
2581 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
2582 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
2583 WDP_LOGF("Failed to allocate memory for event. [%s]",
2585 __WDP_LOG_FUNC_EXIT__;
2588 memset(&event, 0x0, sizeof(wfd_oem_event_s));
2590 event.edata = (void*) edata;
2591 event.edata_type = WFD_OEM_EDATA_TYPE_GROUP;
2592 event.event_id = WFD_OEM_EVENT_GROUP_CREATED;
2594 if (parameters != NULL) {
2595 g_variant_get(parameters, "(a{sv})", &iter);
2598 dbus_property_foreach(iter, __ws_extract_group_details, &event);
2599 g_variant_iter_free(iter);
2602 WDP_LOGE("No properties");
2605 if (g_pd->callback->group_created_cb)
2606 g_pd->callback->group_created_cb(&event);
2608 g_free(event.edata);
2610 __WDP_LOG_FUNC_EXIT__;
2613 static void _ws_process_go_neg_success(GDBusConnection *connection,
2614 const gchar *sender, const gchar *object_path, const gchar *interface,
2615 const gchar *signal, GVariant *parameters, gpointer user_data)
2617 __WDP_LOG_FUNC_ENTER__;
2618 GVariantIter *iter = NULL;
2619 wfd_oem_event_s event;
2620 wfd_oem_conn_data_s *edata = NULL;
2622 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2624 if (!g_pd || !g_pd->callback) {
2625 WDP_LOGD("Ignoring event");
2626 __WDP_LOG_FUNC_EXIT__;
2630 edata = (wfd_oem_conn_data_s*)calloc(1, sizeof(wfd_oem_conn_data_s));
2632 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
2633 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
2634 WDP_LOGF("Failed to allocate memory for event. [%s]",
2636 __WDP_LOG_FUNC_EXIT__;
2639 memset(&event, 0x0, sizeof(wfd_oem_event_s));
2641 event.edata = edata;
2642 event.edata_type = WFD_OEM_EDATA_TYPE_CONN;
2643 event.event_id = WFD_OEM_EVENT_GO_NEG_DONE;
2645 if (parameters != NULL) {
2646 g_variant_get(parameters, "(a{sv})", &iter);
2649 dbus_property_foreach(iter, __ws_extract_gonegsuccess_details, &event);
2650 g_variant_iter_free(iter);
2653 WDP_LOGE("No properties");
2656 if (g_pd->callback->go_neg_done_cb)
2657 g_pd->callback->go_neg_done_cb(&event);
2661 __WDP_LOG_FUNC_EXIT__;
2664 static void _ws_process_go_neg_failure(GDBusConnection *connection,
2665 const gchar *sender, const gchar *object_path, const gchar *interface,
2666 const gchar *signal, GVariant *parameters, gpointer user_data)
2668 __WDP_LOG_FUNC_ENTER__;
2669 GVariantIter *iter = NULL;
2670 wfd_oem_event_s event;
2671 wfd_oem_conn_data_s *edata = NULL;
2673 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2675 if (!g_pd || !g_pd->callback) {
2676 WDP_LOGD("Ignoring event");
2677 __WDP_LOG_FUNC_EXIT__;
2681 edata = (wfd_oem_conn_data_s *) g_try_malloc0(sizeof(wfd_oem_conn_data_s));
2683 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
2684 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
2685 WDP_LOGF("Failed to allocate memory for event. [%s]",
2687 __WDP_LOG_FUNC_EXIT__;
2690 memset(&event, 0x0, sizeof(wfd_oem_event_s));
2692 event.edata = (void*) edata;
2693 event.edata_type = WFD_OEM_EDATA_TYPE_DEVICE;
2694 event.event_id = WFD_OEM_EVENT_GO_NEG_FAIL;
2696 if (parameters != NULL) {
2697 g_variant_get(parameters, "(a{sv})", &iter);
2700 dbus_property_foreach(iter, __ws_extract_gonegfailaure_details, &event);
2701 g_variant_iter_free(iter);
2704 WDP_LOGE("No properties");
2707 if (g_pd->callback->go_neg_fail_cb)
2708 g_pd->callback->go_neg_fail_cb(&event);
2710 g_free(event.edata);
2712 __WDP_LOG_FUNC_EXIT__;
2715 static void __set_wps_mode_for_event(int dev_passwd_id, wfd_oem_event_s *event)
2720 WDP_LOGD("Retrive dev_passwd_id [%d]", dev_passwd_id);
2722 if (dev_passwd_id == WS_DEV_PASSWD_ID_PUSH_BUTTON)
2723 event->wps_mode = WFD_OEM_WPS_MODE_PBC;
2724 else if (dev_passwd_id == WS_DEV_PASSWD_ID_REGISTRAR_SPECIFIED)
2725 event->wps_mode = WFD_OEM_WPS_MODE_DISPLAY;
2726 else if (dev_passwd_id == WS_DEV_PASSWD_ID_USER_SPECIFIED)
2727 event->wps_mode = WFD_OEM_WPS_MODE_KEYPAD;
2729 event->wps_mode = WFD_OEM_WPS_MODE_NONE;
2732 static void _ws_process_go_neg_request(GDBusConnection *connection,
2733 const gchar *sender, const gchar *object_path, const gchar *interface,
2734 const gchar *signal, GVariant *parameters, gpointer user_data)
2736 __WDP_LOG_FUNC_ENTER__;
2737 wfd_oem_event_s event;
2738 wfd_oem_dev_data_s *dev_data = NULL;
2739 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
2740 const char *path = NULL;
2741 int dev_passwd_id = 0;
2742 int device_go_intent = 0;
2744 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2746 if (!__is_valid_plugin())
2749 dev_data = __create_dev_data();
2751 __WDP_LOG_FUNC_EXIT__;
2754 __set_event_data(WFD_OEM_EVENT_GO_NEG_REQ,
2755 WFD_OEM_EDATA_TYPE_DEVICE,
2759 g_variant_get(parameters, "(&oqy)", &path, &dev_passwd_id, &device_go_intent);
2760 g_strlcpy(peer_path, path, DBUS_OBJECT_PATH_MAX);
2762 WDP_LOGD("Retrive peer path [%s]", peer_path);
2763 __set_wps_mode_for_event(dev_passwd_id, &event);
2764 WDP_LOGD("Retrive device_go_intent [%d]", device_go_intent);
2765 dev_data->device_go_intent = device_go_intent;
2767 __extract_addr_from_path(peer_path, event.dev_addr);
2769 dbus_property_get_all(peer_path, g_pd->g_dbus, SUPPLICANT_P2P_PEER,
2770 __ws_peer_property, event.edata);
2772 if (g_pd->callback->go_neg_req_cb)
2773 g_pd->callback->go_neg_req_cb(&event);
2775 __destroy_dev_data(dev_data);
2777 __WDP_LOG_FUNC_EXIT__;
2779 static void _ws_process_invitation_received(GDBusConnection *connection,
2780 const gchar *sender, const gchar *object_path, const gchar *interface,
2781 const gchar *signal, GVariant *parameters, gpointer user_data)
2783 __WDP_LOG_FUNC_ENTER__;
2784 GVariantIter *iter = NULL;
2785 wfd_oem_event_s event;
2786 wfd_oem_invite_data_s *edata = NULL;
2788 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2790 if (!g_pd || !g_pd->callback) {
2791 WDP_LOGD("Ignoring event");
2792 __WDP_LOG_FUNC_EXIT__;
2796 edata = (wfd_oem_invite_data_s *) g_try_malloc0(sizeof(wfd_oem_invite_data_s));
2798 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
2799 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
2800 WDP_LOGF("Failed to allocate memory for event. [%s]",
2802 __WDP_LOG_FUNC_EXIT__;
2805 memset(&event, 0x0, sizeof(wfd_oem_event_s));
2807 event.edata = (void*) edata;
2808 event.edata_type = WFD_OEM_EDATA_TYPE_INVITE;
2809 event.event_id = WFD_OEM_EVENT_INVITATION_REQ;
2811 if (parameters != NULL) {
2812 g_variant_get(parameters, "(a{sv})", &iter);
2815 dbus_property_foreach(iter, __ws_extract_invitation_details, &event);
2816 g_variant_iter_free(iter);
2819 WDP_LOGE("No properties");
2821 memcpy(&(event.dev_addr), edata->sa, OEM_MACADDR_LEN);
2823 if (g_pd->callback->invitation_req_cb)
2824 g_pd->callback->invitation_req_cb(&event);
2826 g_free(event.edata);
2828 __WDP_LOG_FUNC_EXIT__;
2831 static void _ws_process_invitation_result(GDBusConnection *connection,
2832 const gchar *sender, const gchar *object_path, const gchar *interface,
2833 const gchar *signal, GVariant *parameters, gpointer user_data)
2835 __WDP_LOG_FUNC_ENTER__;
2836 wfd_oem_event_s event;
2838 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2840 if (!g_pd || !g_pd->callback) {
2841 WDP_LOGD("Ignoring event");
2842 __WDP_LOG_FUNC_EXIT__;
2846 memset(&event, 0x0, sizeof(wfd_oem_event_s));
2848 __WDP_LOG_FUNC_EXIT__;
2851 static void _ws_process_group_finished(GDBusConnection *connection,
2852 const gchar *sender, const gchar *object_path, const gchar *interface,
2853 const gchar *signal, GVariant *parameters, gpointer user_data)
2855 __WDP_LOG_FUNC_ENTER__;
2856 wfd_oem_event_s event;
2859 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2861 if (!g_pd || !g_pd->callback) {
2862 WDP_LOGD("Ignoring event");
2863 __WDP_LOG_FUNC_EXIT__;
2867 memset(&event, 0x0, sizeof(wfd_oem_event_s));
2869 event.event_id = WFD_OEM_EVENT_GROUP_DESTROYED;
2870 event.edata_type = WFD_OEM_EDATA_TYPE_NONE;
2872 for (i = 0; ws_group_signal_map[i].member != NULL; i++) {
2873 g_dbus_connection_signal_unsubscribe(g_pd->g_dbus, ws_group_signal_map[i].sub_id);
2874 ws_group_signal_map[i].sub_id = 0;
2877 _ws_manage_group_iface_signal(interface, FALSE);
2878 memset(g_pd->group_iface_path, 0x0, DBUS_OBJECT_PATH_MAX);
2879 if (g_pd->callback->group_destroyed_cb)
2880 g_pd->callback->group_destroyed_cb(&event);
2884 __WDP_LOG_FUNC_EXIT__;
2887 static void _ws_process_service_discovery_response(GDBusConnection *connection,
2888 const gchar *sender, const gchar *object_path, const gchar *interface,
2889 const gchar *signal, GVariant *parameters, gpointer user_data)
2891 __WDP_LOG_FUNC_ENTER__;
2892 GVariantIter *iter = NULL;
2893 wfd_oem_event_s event;
2895 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2897 if (!g_pd || !g_pd->callback) {
2898 WDP_LOGD("Ignoring event");
2899 __WDP_LOG_FUNC_EXIT__;
2903 memset(&event, 0x0, sizeof(wfd_oem_event_s));
2905 event.event_id = WFD_OEM_EVENT_SERV_DISC_RESP;
2907 if (parameters != NULL) {
2908 g_variant_get(parameters, "(a{sv})", &iter);
2910 dbus_property_foreach(iter, __ws_extract_servicediscoveryresponse_details, &event);
2911 event.edata_type = WFD_OEM_EDATA_TYPE_NEW_SERVICE;
2912 g_variant_iter_free(iter);
2915 WDP_LOGE("No Properties");
2918 if (g_pd->callback->serv_disc_resp_cb)
2919 g_pd->callback->serv_disc_resp_cb(&event);
2921 if (event.edata_type == WFD_OEM_EDATA_TYPE_NEW_SERVICE)
2922 g_list_free((GList*) event.edata);
2924 __WDP_LOG_FUNC_EXIT__;
2927 static void _ws_process_service_asp_response(GDBusConnection *connection,
2928 const gchar *sender, const gchar *object_path, const gchar *interface,
2929 const gchar *signal, GVariant *parameters, gpointer user_data)
2931 __WDP_LOG_FUNC_ENTER__;
2932 GVariantIter *iter = NULL;
2933 wfd_oem_event_s event;
2934 wfd_oem_asp_service_s *service = NULL;
2935 wfd_oem_asp_service_s *tmp = NULL;
2937 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
2939 if (!g_pd || !g_pd->callback) {
2940 WDP_LOGD("Ignoring event");
2941 __WDP_LOG_FUNC_EXIT__;
2945 service = (wfd_oem_asp_service_s *) g_try_malloc0(sizeof(wfd_oem_asp_service_s));
2947 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
2948 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
2949 WDP_LOGF("Failed to allocate memory for event. [%s]",
2951 __WDP_LOG_FUNC_EXIT__;
2954 memset(&event, 0x0, sizeof(wfd_oem_event_s));
2956 event.edata = (void*) service;
2957 event.edata_type = WFD_OEM_EDATA_TYPE_ASP_SERVICE;
2958 event.event_id = WFD_OEM_EVENT_ASP_SERV_RESP;
2960 if (parameters != NULL) {
2961 g_variant_get(parameters, "(a{sv})", &iter);
2963 dbus_property_foreach(iter, __ws_extract_serviceaspresponse_details, &event);
2964 g_variant_iter_free(iter);
2967 WDP_LOGE("No Properties");
2969 GLIST_ITER_START(seek_list, tmp)
2970 if (tmp->tran_id == service->tran_id) {
2971 WDP_LOGD("srv_trans_id matched [%d] search_id [%llu]"
2972 , tmp->tran_id, tmp->search_id);
2973 service->search_id = tmp->search_id;
2980 if (tmp != NULL && tmp->service_info != NULL) {
2981 if (g_pd->callback->asp_serv_resp_cb)
2982 g_pd->callback->asp_serv_resp_cb(&event);
2984 WDP_LOGD("service info is not required, don't notify to user");
2987 g_free(service->service_type);
2988 g_free(service->service_info);
2991 __WDP_LOG_FUNC_EXIT__;
2994 static void _ws_process_persistent_group_added(GDBusConnection *connection,
2995 const gchar *sender, const gchar *object_path, const gchar *interface,
2996 const gchar *signal, GVariant *parameters, gpointer user_data)
2998 __WDP_LOG_FUNC_ENTER__;
2999 wfd_oem_event_s event;
3001 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
3003 if (!g_pd || !g_pd->callback) {
3004 WDP_LOGD("Ignoring event");
3005 __WDP_LOG_FUNC_EXIT__;
3009 memset(&event, 0x0, sizeof(wfd_oem_event_s));
3011 __WDP_LOG_FUNC_EXIT__;
3014 static void _ws_process_persistent_group_removed(GDBusConnection *connection,
3015 const gchar *sender, const gchar *object_path, const gchar *interface,
3016 const gchar *signal, GVariant *parameters, gpointer user_data)
3018 __WDP_LOG_FUNC_ENTER__;
3019 wfd_oem_event_s event;
3021 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
3023 if (!g_pd || !g_pd->callback) {
3024 WDP_LOGD("Ignoring event");
3025 __WDP_LOG_FUNC_EXIT__;
3029 memset(&event, 0x0, sizeof(wfd_oem_event_s));
3031 __WDP_LOG_FUNC_EXIT__;
3034 static void _ws_process_wps_failed(GDBusConnection *connection,
3035 const gchar *sender, const gchar *object_path, const gchar *interface,
3036 const gchar *signal, GVariant *parameters, gpointer user_data)
3038 __WDP_LOG_FUNC_ENTER__;
3039 GVariantIter *iter = NULL;
3040 wfd_oem_event_s event;
3041 const char *name = NULL;
3043 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
3045 if (!g_pd || !g_pd->callback) {
3046 WDP_LOGD("Ignoring event");
3047 __WDP_LOG_FUNC_EXIT__;
3051 memset(&event, 0x0, sizeof(wfd_oem_event_s));
3053 event.event_id = WFD_OEM_EVENT_WPS_FAIL;
3054 event.edata_type = WFD_OEM_EDATA_TYPE_NONE;
3056 g_variant_get(parameters, "(&sa{sv})", &name, &iter);
3058 WDP_LOGD("code [%s]", name);
3063 GVariant *value = NULL;
3065 while (g_variant_iter_loop(iter, "{sv}", &key, &value))
3066 CHECK_KEY_VALUE(key, value);
3068 g_variant_iter_free(iter);
3071 if (g_pd->callback->wps_fail_cb)
3072 g_pd->callback->wps_fail_cb(&event);
3074 __WDP_LOG_FUNC_EXIT__;
3077 static void _ws_process_group_formation_failure(GDBusConnection *connection,
3078 const gchar *sender, const gchar *object_path, const gchar *interface,
3079 const gchar *signal, GVariant *parameters, gpointer user_data)
3081 __WDP_LOG_FUNC_ENTER__;
3082 wfd_oem_event_s event;
3084 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
3086 if (!g_pd || !g_pd->callback) {
3087 WDP_LOGD("Ignoring event");
3088 __WDP_LOG_FUNC_EXIT__;
3092 memset(&event, 0x0, sizeof(wfd_oem_event_s));
3094 event.event_id = WFD_OEM_EVENT_GROUP_FORMATION_FAILURE;
3095 event.edata_type = WFD_OEM_EDATA_TYPE_NONE;
3097 if (g_pd->callback->group_formation_failure_cb)
3098 g_pd->callback->group_formation_failure_cb(&event);
3100 __WDP_LOG_FUNC_EXIT__;
3103 static void _ws_process_invitation_accepted(GDBusConnection *connection,
3104 const gchar *sender, const gchar *object_path, const gchar *interface,
3105 const gchar *signal, GVariant *parameters, gpointer user_data)
3107 __WDP_LOG_FUNC_ENTER__;
3108 GVariantIter *iter = NULL;
3109 wfd_oem_event_s event;
3111 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
3113 if (!g_pd || !g_pd->callback) {
3114 WDP_LOGD("Ignoring event");
3115 __WDP_LOG_FUNC_EXIT__;
3119 memset(&event, 0x0, sizeof(wfd_oem_event_s));
3121 event.event_id = WFD_OEM_EVENT_INVITATION_ACCEPTED;
3122 event.edata_type = WFD_OEM_EDATA_TYPE_NONE;
3124 if (parameters != NULL) {
3125 g_variant_get(parameters, "(a{sv})", &iter);
3129 GVariant *value = NULL;
3131 while (g_variant_iter_loop(iter, "{sv}", &key, &value)) {
3132 CHECK_KEY_VALUE(key, value);
3134 if (g_strcmp0(key, "sa") == 0)
3135 if (__ws_unpack_ay(event.dev_addr, value, WS_MACADDR_LEN))
3136 WDP_LOGI("[" MACSTR "]", MAC2STR(event.dev_addr));
3138 g_variant_iter_free(iter);
3142 if (g_pd->callback->invitation_accepted_cb)
3143 g_pd->callback->invitation_accepted_cb(&event);
3145 __WDP_LOG_FUNC_EXIT__;
3148 static void _ws_process_asp_provision_start(GDBusConnection *connection,
3149 const gchar *sender, const gchar *object_path, const gchar *interface,
3150 const gchar *signal, GVariant *parameters, gpointer user_data)
3152 __WDP_LOG_FUNC_ENTER__;
3153 GVariantIter *iter = NULL;
3154 wfd_oem_event_s event;
3155 wfd_oem_asp_prov_s *edata;
3157 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
3159 if (!g_pd || !g_pd->callback) {
3160 WDP_LOGD("Ignoring event");
3161 __WDP_LOG_FUNC_EXIT__;
3165 edata = (wfd_oem_asp_prov_s *) g_try_malloc0(sizeof(wfd_oem_asp_prov_s));
3167 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
3168 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
3169 WDP_LOGF("Failed to allocate memory for event. [%s]",
3171 __WDP_LOG_FUNC_EXIT__;
3174 memset(&event, 0x0, sizeof(wfd_oem_event_s));
3176 event.edata = (void*) edata;
3177 event.event_id = WFD_OEM_EVENT_ASP_PROV_START;
3179 if (parameters != NULL) {
3180 g_variant_get(parameters, "(a{sv})", &iter);
3182 dbus_property_foreach(iter, __ws_extract_asp_provision_start_details, &event);
3183 event.edata_type = WFD_OEM_EDATA_TYPE_ASP_PROV;
3184 g_variant_iter_free(iter);
3187 WDP_LOGE("No Properties");
3190 if (g_pd->callback->asp_prov_start_cb)
3191 g_pd->callback->asp_prov_start_cb(&event);
3193 if (event.edata_type == WFD_OEM_EDATA_TYPE_ASP_PROV)
3194 g_free(edata->session_information);
3197 __WDP_LOG_FUNC_EXIT__;
3200 static void _ws_process_asp_provision_done(GDBusConnection *connection,
3201 const gchar *sender, const gchar *object_path, const gchar *interface,
3202 const gchar *signal, GVariant *parameters, gpointer user_data)
3204 __WDP_LOG_FUNC_ENTER__;
3205 GVariantIter *iter = NULL;
3206 wfd_oem_event_s event;
3207 wfd_oem_asp_prov_s *edata;
3209 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
3211 if (!g_pd || !g_pd->callback) {
3212 WDP_LOGD("Ignoring event");
3213 __WDP_LOG_FUNC_EXIT__;
3217 edata = (wfd_oem_asp_prov_s *) g_try_malloc0(sizeof(wfd_oem_asp_prov_s));
3219 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
3220 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
3221 WDP_LOGF("Failed to allocate memory for event. [%s]",
3223 __WDP_LOG_FUNC_EXIT__;
3226 memset(&event, 0x0, sizeof(wfd_oem_event_s));
3228 event.edata = (void*) edata;
3229 event.event_id = WFD_OEM_EVENT_ASP_PROV_DONE;
3231 if (parameters != NULL) {
3232 g_variant_get(parameters, "(a{sv})", &iter);
3234 dbus_property_foreach(iter, __ws_extract_asp_provision_done_details, &event);
3235 event.edata_type = WFD_OEM_EDATA_TYPE_ASP_PROV;
3236 g_variant_iter_free(iter);
3239 WDP_LOGE("No Properties");
3242 if (g_pd->callback->asp_prov_done_cb)
3243 g_pd->callback->asp_prov_done_cb(&event);
3247 __WDP_LOG_FUNC_EXIT__;
3252 const char *interface;
3254 void (*function) (GDBusConnection *connection,
3255 const gchar *sender, const gchar *object_path, const gchar *interface,
3256 const gchar *signal, GVariant *parameters, gpointer user_data);
3257 } ws_p2pdevice_signal_map[] = {
3260 SUPPLICANT_P2PDEVICE,
3261 "DeviceFoundProperties",
3262 _ws_process_device_found_properties
3266 SUPPLICANT_P2PDEVICE,
3268 _ws_process_device_lost
3272 SUPPLICANT_P2PDEVICE,
3274 _ws_process_find_stoppped
3278 SUPPLICANT_P2PDEVICE,
3279 "ProvisionDiscoveryRequestDisplayPin",
3280 _ws_process_prov_disc_req_display_pin
3284 SUPPLICANT_P2PDEVICE,
3285 "ProvisionDiscoveryResponseDisplayPin",
3286 _ws_process_prov_disc_resp_display_pin
3290 SUPPLICANT_P2PDEVICE,
3291 "ProvisionDiscoveryRequestEnterPin",
3292 _ws_process_prov_disc_req_enter_pin
3296 SUPPLICANT_P2PDEVICE,
3297 "ProvisionDiscoveryResponseEnterPin",
3298 _ws_process_prov_disc_resp_enter_pin
3302 SUPPLICANT_P2PDEVICE,
3303 "ProvisionDiscoveryPBCRequest",
3304 _ws_process_prov_disc_pbc_req
3308 SUPPLICANT_P2PDEVICE,
3309 "ProvisionDiscoveryPBCResponse",
3310 _ws_process_prov_disc_pbc_resp
3314 SUPPLICANT_P2PDEVICE,
3315 "ProvisionDiscoveryFailure",
3316 _ws_process_prov_disc_failure
3320 SUPPLICANT_P2PDEVICE,
3322 _ws_process_group_started
3326 SUPPLICANT_P2PDEVICE,
3327 "GONegotiationSuccess",
3328 _ws_process_go_neg_success
3332 SUPPLICANT_P2PDEVICE,
3333 "GONegotiationFailure",
3334 _ws_process_go_neg_failure
3338 SUPPLICANT_P2PDEVICE,
3339 "GONegotiationRequest",
3340 _ws_process_go_neg_request
3344 SUPPLICANT_P2PDEVICE,
3345 "InvitationReceived",
3346 _ws_process_invitation_received
3350 SUPPLICANT_P2PDEVICE,
3352 _ws_process_invitation_result
3356 SUPPLICANT_P2PDEVICE,
3358 _ws_process_group_finished
3362 SUPPLICANT_P2PDEVICE,
3363 "ServiceDiscoveryResponse",
3364 _ws_process_service_discovery_response
3368 SUPPLICANT_P2PDEVICE,
3369 "ServiceASPResponse",
3370 _ws_process_service_asp_response
3374 SUPPLICANT_P2PDEVICE,
3375 "ASPProvisionStart",
3376 _ws_process_asp_provision_start
3380 SUPPLICANT_P2PDEVICE,
3382 _ws_process_asp_provision_done
3386 SUPPLICANT_P2PDEVICE,
3387 "PersistentGroupAdded",
3388 _ws_process_persistent_group_added
3392 SUPPLICANT_P2PDEVICE,
3393 "PersistentGroupRemoved",
3394 _ws_process_persistent_group_removed
3398 SUPPLICANT_P2PDEVICE,
3400 _ws_process_wps_failed
3404 SUPPLICANT_P2PDEVICE,
3405 "GroupFormationFailure",
3406 _ws_process_group_formation_failure
3410 SUPPLICANT_P2PDEVICE,
3411 "InvitationAccepted",
3412 _ws_process_invitation_accepted
3422 static void _ws_process_sta_authorized(GDBusConnection *connection,
3423 const gchar *sender, const gchar *object_path, const gchar *interface,
3424 const gchar *signal, GVariant *parameters, gpointer user_data)
3426 __WDP_LOG_FUNC_ENTER__;
3427 wfd_oem_event_s event;
3428 const gchar* mac_str = NULL;
3430 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
3432 if (!g_pd || !g_pd->callback) {
3433 WDP_LOGD("Ignoring event");
3434 __WDP_LOG_FUNC_EXIT__;
3438 if (is_peer_joined_notified) {
3439 is_peer_joined_notified = 0;
3440 __WDP_LOG_FUNC_EXIT__;
3444 memset(&event, 0x0, sizeof(wfd_oem_event_s));
3445 g_variant_get(parameters, "(&s)", &mac_str);
3446 __ws_txt_to_mac((unsigned char *)mac_str, event.intf_addr);
3448 event.event_id = WFD_OEM_EVENT_STA_CONNECTED;
3449 event.edata_type = WFD_OEM_EDATA_TYPE_NONE;
3451 if (g_pd->callback->sta_connected_cb)
3452 g_pd->callback->sta_connected_cb(&event);
3454 __WDP_LOG_FUNC_EXIT__;
3457 static void _ws_process_sta_deauthorized(GDBusConnection *connection,
3458 const gchar *sender, const gchar *object_path, const gchar *interface,
3459 const gchar *signal, GVariant *parameters, gpointer user_data)
3461 __WDP_LOG_FUNC_ENTER__;
3462 wfd_oem_event_s event;
3463 const gchar* mac_str = NULL;
3465 DEBUG_SIGNAL(sender, object_path, interface, signal, parameters);
3467 if (!g_pd || !g_pd->callback) {
3468 WDP_LOGD("Ignoring event");
3469 __WDP_LOG_FUNC_EXIT__;
3473 if (is_peer_disconnected_notified) {
3474 is_peer_disconnected_notified = 0;
3475 __WDP_LOG_FUNC_EXIT__;
3479 memset(&event, 0x0, sizeof(wfd_oem_event_s));
3480 g_variant_get(parameters, "(&s)", &mac_str);
3481 __ws_txt_to_mac((unsigned char *)mac_str, event.intf_addr);
3483 event.event_id = WFD_OEM_EVENT_STA_DISCONNECTED;
3484 event.edata_type = WFD_OEM_EDATA_TYPE_NONE;
3486 if (g_pd->callback->sta_disconnected_cb)
3487 g_pd->callback->sta_disconnected_cb(&event);
3489 __WDP_LOG_FUNC_EXIT__;
3494 const char *interface;
3496 void (*function) (GDBusConnection *connection,
3497 const gchar *sender, const gchar *object_path, const gchar *interface,
3498 const gchar *signal, GVariant *parameters, gpointer user_data);
3499 } ws_interface_signal_map[] = {
3504 _ws_process_sta_authorized
3510 _ws_process_sta_deauthorized
3522 const char *interface;
3524 void (*function) (GDBusConnection *connection,
3525 const gchar *sender, const gchar *object_path, const gchar *interface,
3526 const gchar *signal, GVariant *parameters, gpointer user_data);
3527 } ws_group_interface_signal_map[] = {
3532 _ws_process_sta_authorized
3538 _ws_process_sta_deauthorized
3548 static void __register_p2pdevice_signal(GVariant *value, void *user_data)
3550 __WDP_LOG_FUNC_ENTER__;
3551 ws_dbus_plugin_data_s * pd_data;
3552 static char interface_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
3553 const char *path = NULL;
3557 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
3558 __WDP_LOG_FUNC_EXIT__;
3562 pd_data = (ws_dbus_plugin_data_s *)g_pd;
3564 g_variant_get(value, "(&o)", &path);
3565 g_strlcpy(interface_path, path, DBUS_OBJECT_PATH_MAX);
3566 g_strlcpy(pd_data->iface_path, path, DBUS_OBJECT_PATH_MAX);
3568 WDP_LOGD("interface object path [%s]", interface_path);
3570 /* subscribe Interface iface signal */
3571 for (i = 0; ws_interface_signal_map[i].member != NULL; i++) {
3572 ws_interface_signal_map[i].sub_id =
3573 g_dbus_connection_signal_subscribe(pd_data->g_dbus,
3574 SUPPLICANT_SERVICE, /* bus name */
3575 ws_interface_signal_map[i].interface, /* interface */
3576 ws_interface_signal_map[i].member, /* member */
3577 pd_data->iface_path, /* object path */
3579 G_DBUS_SIGNAL_FLAGS_NONE,
3580 ws_interface_signal_map[i].function,
3582 WDP_LOGD("Subscribed Interface iface signal [%s]", ws_interface_signal_map[i].member);
3585 /* subscribe P2PDevice iface signal */
3586 for (i = 0; ws_p2pdevice_signal_map[i].member != NULL; i++) {
3587 ws_p2pdevice_signal_map[i].sub_id =
3588 g_dbus_connection_signal_subscribe(pd_data->g_dbus,
3589 SUPPLICANT_SERVICE, /* bus name */
3590 ws_p2pdevice_signal_map[i].interface, /* interface */
3591 ws_p2pdevice_signal_map[i].member, /* member */
3592 pd_data->iface_path, /* object path */
3594 G_DBUS_SIGNAL_FLAGS_NONE,
3595 ws_p2pdevice_signal_map[i].function,
3597 WDP_LOGD("Subscribed P2PDevice iface signal [%s]", ws_p2pdevice_signal_map[i].member);
3600 __WDP_LOG_FUNC_EXIT__;
3603 static int _ws_create_interface(const char *iface_name, handle_reply function, void *user_data)
3605 __WDP_LOG_FUNC_ENTER__;
3606 GDBusConnection *g_dbus = NULL;
3607 GVariantBuilder *builder = NULL;
3608 dbus_method_param_s params;
3613 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
3614 __WDP_LOG_FUNC_EXIT__;
3618 g_dbus = g_pd->g_dbus;
3620 WDP_LOGE("DBus connection is NULL");
3621 __WDP_LOG_FUNC_EXIT__;
3624 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
3626 dbus_set_method_param(¶ms, "CreateInterface", SUPPLICANT_PATH, g_dbus);
3628 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
3629 g_variant_builder_add(builder, "{sv}", "Ifname", g_variant_new_string(iface_name));
3630 g_variant_builder_add(builder, "{sv}", "ConfigFile", g_variant_new_string(CONF_FILE_PATH));
3631 params.params = g_variant_new("(a{sv})", builder);
3632 g_variant_builder_unref(builder);
3633 res = dbus_method_call(¶ms, SUPPLICANT_INTERFACE, function, user_data);
3635 WDP_LOGE("Failed to send command to wpa_supplicant");
3637 WDP_LOGD("Succeeded to CreateInterface");
3639 __WDP_LOG_FUNC_EXIT__;
3643 static int _ws_get_interface(const char *iface_name, handle_reply function, void *user_data)
3645 __WDP_LOG_FUNC_ENTER__;
3646 GDBusConnection *g_dbus = NULL;
3647 dbus_method_param_s params;
3651 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
3652 __WDP_LOG_FUNC_EXIT__;
3656 g_dbus = g_pd->g_dbus;
3658 WDP_LOGE("DBus connection is NULL");
3659 __WDP_LOG_FUNC_EXIT__;
3663 dbus_set_method_param(¶ms, SUPPLICANT_METHOD_GETINTERFACE,
3664 SUPPLICANT_PATH, g_pd->g_dbus);
3666 params.params = g_variant_new("(s)", iface_name);
3667 DEBUG_G_VARIANT("Params : ", params.params);
3669 res = dbus_method_call(¶ms, SUPPLICANT_INTERFACE,
3670 function, user_data);
3673 WDP_LOGE("Failed to send command to wpa_supplicant");
3675 WDP_LOGD("Succeeded to get interface");
3677 __WDP_LOG_FUNC_EXIT__;
3681 static void __ws_remove_interface(GVariant *value, void *user_data)
3683 __WDP_LOG_FUNC_ENTER__;
3684 GDBusConnection *g_dbus = NULL;
3685 dbus_method_param_s params;
3686 const char *path = NULL;
3687 static char interface_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
3691 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
3695 g_dbus = g_pd->g_dbus;
3697 WDP_LOGE("DBus connection is NULL");
3701 g_variant_get(value, "(&o)", &path);
3702 g_strlcpy(interface_path, path, DBUS_OBJECT_PATH_MAX);
3703 WDP_LOGD("interface object path [%s]", interface_path);
3705 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
3707 dbus_set_method_param(¶ms, "RemoveInterface", SUPPLICANT_PATH, g_dbus);
3708 params.params = g_variant_new("(o)", interface_path);
3710 res = dbus_method_call(¶ms, SUPPLICANT_INTERFACE, NULL, NULL);
3712 WDP_LOGE("Failed to send command to wpa_supplicant");
3714 WDP_LOGD("Succeeded to RemoveInterface");
3716 __WDP_LOG_FUNC_EXIT__;
3720 static int _ws_init_dbus_connection(void)
3722 __WDP_LOG_FUNC_ENTER__;
3723 GDBusConnection *conn = NULL;
3724 GError *error = NULL;
3729 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
3730 __WDP_LOG_FUNC_EXIT__;
3735 WDP_LOGE("no configurable data found");
3736 __WDP_LOG_FUNC_EXIT__;
3740 conn = g_bus_get_sync(G_BUS_TYPE_SYSTEM, NULL, &error);
3743 if (error != NULL) {
3744 WDP_LOGE("Error! Failed to connect to the D-BUS daemon: [%s]",
3746 g_error_free(error);
3748 __WDP_LOG_FUNC_EXIT__;
3752 g_pd->g_dbus = conn;
3754 for (i = 0; ws_supplicant_signal_map[i].member != NULL; i++) {
3755 ws_supplicant_signal_map[i].sub_id =
3756 g_dbus_connection_signal_subscribe(g_pd->g_dbus,
3757 SUPPLICANT_SERVICE, /* bus name */
3758 ws_supplicant_signal_map[i].interface, /* interface */
3759 ws_supplicant_signal_map[i].member, /* member */
3760 SUPPLICANT_PATH, /* object path */
3762 G_DBUS_SIGNAL_FLAGS_NONE,
3763 ws_supplicant_signal_map[i].function,
3765 WDP_LOGD("Subscribed supplicant iface signal [%s]", ws_supplicant_signal_map[i].member);
3768 if (g_strcmp0(config->ifname, config->p2p_ifname) != 0) {
3769 if (_ws_get_interface(config->ifname, NULL, NULL) < 0)
3770 res = _ws_create_interface(config->ifname, NULL, NULL);
3771 if (_ws_get_interface(config->p2p_ifname, __register_p2pdevice_signal, NULL) < 0)
3772 res = _ws_create_interface(config->p2p_ifname, __register_p2pdevice_signal, NULL);
3774 if (_ws_get_interface(config->p2p_ifname, __register_p2pdevice_signal, NULL) < 0)
3775 res = _ws_create_interface(config->p2p_ifname, __register_p2pdevice_signal, NULL);
3779 WDP_LOGE("Failed to subscribe interface signal");
3781 WDP_LOGI("Successfully register signal filters");
3783 __WDP_LOG_FUNC_EXIT__;
3787 static int _ws_deinit_dbus_connection(void)
3789 GDBusConnection *g_dbus = NULL;
3793 WDP_LOGE("Invalid parameter");
3794 __WDP_LOG_FUNC_EXIT__;
3798 g_dbus = g_pd->g_dbus;
3800 WDP_LOGE("DBus connection is NULL");
3801 __WDP_LOG_FUNC_EXIT__;
3805 for (i = 0; ws_supplicant_signal_map[i].member != NULL; i++) {
3806 g_dbus_connection_signal_unsubscribe(g_dbus, ws_supplicant_signal_map[i].sub_id);
3807 ws_supplicant_signal_map[i].sub_id = 0;
3810 for (i = 0; ws_interface_signal_map[i].member != NULL; i++) {
3811 g_dbus_connection_signal_unsubscribe(g_dbus, ws_interface_signal_map[i].sub_id);
3812 ws_interface_signal_map[i].sub_id = 0;
3815 for (i = 0; ws_p2pdevice_signal_map[i].member != NULL; i++) {
3816 g_dbus_connection_signal_unsubscribe(g_dbus, ws_p2pdevice_signal_map[i].sub_id);
3817 ws_p2pdevice_signal_map[i].sub_id = 0;
3820 for (i = 0; ws_group_signal_map[i].member != NULL; i++) {
3821 g_dbus_connection_signal_unsubscribe(g_dbus, ws_group_signal_map[i].sub_id);
3822 ws_group_signal_map[i].sub_id = 0;
3825 memset(g_pd->group_iface_path, 0x0, DBUS_OBJECT_PATH_MAX);
3826 memset(g_pd->iface_path, 0x0, DBUS_OBJECT_PATH_MAX);
3828 g_object_unref(g_dbus);
3829 g_pd->g_dbus = NULL;
3830 __WDP_LOG_FUNC_EXIT__;
3834 static void _ws_manage_group_iface_signal(const gchar *group_iface_obj_path,
3835 gboolean is_created)
3837 __WDP_LOG_FUNC_ENTER__;
3838 GDBusConnection *connection;
3842 __WDP_LOG_FUNC_EXIT__;
3846 if (!g_strcmp0(g_pd->iface_path, group_iface_obj_path)) {
3847 WDP_LOGD("group iface is p2p iface, ignore");
3848 __WDP_LOG_FUNC_EXIT__;
3852 connection = g_pd->g_dbus;
3855 /* subscribe Interface iface signal */
3856 for (i = 0; ws_group_interface_signal_map[i].member != NULL; i++) {
3857 ws_group_interface_signal_map[i].sub_id =
3858 g_dbus_connection_signal_subscribe(connection,
3859 SUPPLICANT_SERVICE, /* bus name */
3860 ws_group_interface_signal_map[i].interface, /* interface */
3861 ws_group_interface_signal_map[i].member, /* member */
3862 group_iface_obj_path, /* object path */
3864 G_DBUS_SIGNAL_FLAGS_NONE,
3865 ws_group_interface_signal_map[i].function,
3867 WDP_LOGD("Subscribed Interface iface signal [%s]", ws_group_interface_signal_map[i].member);
3871 for (i = 0; ws_group_interface_signal_map[i].member != NULL; i++) {
3872 g_dbus_connection_signal_unsubscribe(connection, ws_group_interface_signal_map[i].sub_id);
3873 ws_group_interface_signal_map[i].sub_id = 0;
3876 __WDP_LOG_FUNC_EXIT__;
3880 int wfd_plugin_load(wfd_oem_ops_s **ops)
3882 __WDP_LOG_FUNC_ENTER__;
3884 WDP_LOGE("Invalid parameter");
3885 __WDP_LOG_FUNC_EXIT__;
3889 *ops = &supplicant_ops;
3891 __WDP_LOG_FUNC_EXIT__;
3895 static int _ws_reset_plugin(ws_dbus_plugin_data_s *f_pd)
3897 __WDP_LOG_FUNC_ENTER__;
3900 WDP_LOGE("Invalid parameter");
3901 __WDP_LOG_FUNC_EXIT__;
3905 _ws_deinit_dbus_connection();
3907 if (f_pd->activated)
3908 ws_deactivate(f_pd->concurrent);
3912 __WDP_LOG_FUNC_EXIT__;
3916 static int __ws_check_net_interface(char* if_name)
3921 if (if_name == NULL) {
3922 WDP_LOGE("Invalid param");
3926 fd = socket(PF_INET, SOCK_DGRAM | SOCK_CLOEXEC, 0);
3928 WDP_LOGE("socket create error: %d", fd);
3932 memset(&ifr, 0, sizeof(ifr));
3933 g_strlcpy(ifr.ifr_name, if_name, IFNAMSIZ);
3935 if (ioctl(fd, SIOCGIFFLAGS, &ifr) < 0) {
3937 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
3938 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
3939 WDP_LOGE("ioctl error: SIOCGIFFLAGS: %s [ %s ]", error_buf, if_name); /* interface is not found. */
3945 if (ifr.ifr_flags & IFF_UP) {
3946 WDP_LOGD("%s interface is up", if_name);
3950 WDP_LOGD("%s interface is down", if_name);
3954 int ws_configure(wfd_oem_config_s *conf)
3956 __WDP_LOG_FUNC_ENTER__;
3959 __WDP_LOG_FUNC_EXIT__;
3966 config = (wfd_oem_config_s *) g_try_malloc0(sizeof(wfd_oem_config_s));
3968 __WDP_LOG_FUNC_EXIT__;
3972 memcpy(config, conf, sizeof(wfd_oem_config_s));
3974 __WDP_LOG_FUNC_EXIT__;
3978 int ws_init(wfd_oem_event_cbs_s *event_cbs)
3980 __WDP_LOG_FUNC_ENTER__;
3982 if (event_cbs == NULL) {
3983 __WDP_LOG_FUNC_EXIT__;
3988 _ws_reset_plugin(g_pd);
3991 g_pd = (ws_dbus_plugin_data_s*) g_try_malloc0(sizeof(ws_dbus_plugin_data_s));
3993 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
3994 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
3995 WDP_LOGE("Failed to allocate memory for plugin data. [%s]", error_buf);
3999 g_pd->callback = event_cbs;
4000 g_pd->initialized = TRUE;
4002 __WDP_LOG_FUNC_EXIT__;
4008 __WDP_LOG_FUNC_ENTER__;
4011 _ws_reset_plugin(g_pd);
4018 __WDP_LOG_FUNC_EXIT__;
4022 gboolean _ws_util_execute_file(const char *file_path,
4023 char *const args[], char *const envs[])
4028 register unsigned int index = 0;
4029 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
4031 while (args[index] != NULL) {
4032 WDP_LOGD("[%s]", args[index]);
4036 if (!(pid = fork())) {
4037 WDP_LOGD("pid(%d), ppid(%d)", getpid(), getppid());
4038 WDP_LOGD("Inside child, exec (%s) command", file_path);
4041 if (execve(file_path, args, envs) == -1) {
4042 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
4043 WDP_LOGE("Fail to execute command (%s)", error_buf);
4046 } else if (pid > 0) {
4047 if (waitpid(pid, &rv, 0) == -1)
4048 WDP_LOGD("wait pid (%u) rv (%d)", pid, rv);
4050 WDP_LOGD("exited, rv=%d", WEXITSTATUS(rv));
4051 else if (WIFSIGNALED(rv))
4052 WDP_LOGD("killed by signal %d", WTERMSIG(rv));
4053 else if (WIFSTOPPED(rv))
4054 WDP_LOGD("stopped by signal %d", WSTOPSIG(rv));
4055 else if (WIFCONTINUED(rv))
4056 WDP_LOGD("continued");
4061 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
4062 WDP_LOGE("failed to fork (%s)", error_buf);
4066 static int __ws_p2p_firmware_start(const char *interface_name)
4068 GError *error = NULL;
4069 GDBusConnection *conn = g_bus_get_sync(G_BUS_TYPE_SYSTEM, NULL, &error);
4071 WDP_LOGE("Failed to get system bus");
4076 GVariant *params = g_variant_new("(sb)", interface_name, FALSE);
4077 GVariant *reply = g_dbus_connection_call_sync(
4079 NETCONFIG_SERVICE, /* bus name */
4080 NETCONFIG_WIFI_PATH, /* object path */
4081 NETCONFIG_WIFI_INTERFACE, /* interface name */
4082 "LoadDriver", /* method name */
4083 params, /* GVariant *params */
4084 NULL, /* reply_type */
4085 G_DBUS_CALL_FLAGS_NONE, /* flags */
4086 SUPPLICANT_TIMEOUT , /* timeout */
4087 NULL, /* cancellable */
4088 &error); /* error */
4090 if (error != NULL) {
4091 WDP_LOGE("Error! Failed to call method: [%s]", error->message);
4092 g_error_free(error);
4093 __WDP_LOG_FUNC_EXIT__;
4097 g_variant_unref(reply);
4098 g_object_unref(conn);
4103 static int __ws_p2p_firmware_stop(const char *interface_name)
4107 rv = hal_wifi_get_backend();
4109 WDP_LOGD("hal_wifi_get_backend() failed, ret: %d", rv);
4113 rv = hal_wifi_stop(interface_name);
4115 WDP_LOGD("hal_wifi_stop() failed, ret: %d", rv);
4119 WDP_LOGI("Successfully removed p2p device driver");
4123 static int __ws_p2p_supplicant_start(void)
4125 gboolean rv = FALSE;
4126 const char *path = "/usr/sbin/p2p_supp.sh";
4127 char *const args[] = { "/usr/sbin/p2p_supp.sh", "start_dbus", NULL };
4128 char *const envs[] = { NULL };
4130 rv = _ws_util_execute_file(path, args, envs);
4133 WDP_LOGE("Failed to start p2p_supp.sh");
4137 WDP_LOGI("Successfully started p2p_supp.sh");
4142 static int __ws_p2p_supplicant_stop(void)
4144 gboolean rv = FALSE;
4145 const char *path = "/usr/sbin/p2p_supp.sh";
4146 char *const args[] = { "/usr/sbin/p2p_supp.sh", "stop", NULL };
4147 char *const envs[] = { NULL };
4149 rv = _ws_util_execute_file(path, args, envs);
4152 WDP_LOGE("Failed to stop p2p_supp.sh");
4156 WDP_LOGI("Successfully stopped p2p_supp.sh");
4160 static int __ws_p2p_on(void)
4163 DBusMessage *reply = NULL;
4164 DBusMessage *message = NULL;
4165 DBusConnection *connection = NULL;
4167 connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
4168 if (connection == NULL) {
4169 WDP_LOGE("Failed to get system bus");
4173 message = dbus_message_new_method_call(NETCONFIG_SERVICE,
4174 NETCONFIG_WIFI_PATH, NETCONFIG_WIFI_INTERFACE, "LoadP2pDriver");
4175 if (message == NULL) {
4176 WDP_LOGE("Failed DBus method call");
4177 dbus_connection_unref(connection);
4181 dbus_error_init(&error);
4183 reply = dbus_connection_send_with_reply_and_block(connection, message,
4184 NETCONFIG_DBUS_REPLY_TIMEOUT, &error);
4185 if (dbus_error_is_set(&error) == TRUE) {
4186 if (NULL != strstr(error.message, ".AlreadyExists")) {
4187 /* p2p already enabled */
4189 WDP_LOGE("dbus_connection_send_with_reply_and_block() failed. "
4190 "DBus error [%s: %s]", error.name, error.message);
4192 dbus_error_free(&error);
4195 dbus_error_free(&error);
4199 dbus_message_unref(reply);
4201 dbus_message_unref(message);
4202 dbus_connection_unref(connection);
4207 static int __ws_p2p_off(void)
4210 DBusMessage *reply = NULL;
4211 DBusMessage *message = NULL;
4212 DBusConnection *connection = NULL;
4214 connection = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
4215 if (connection == NULL) {
4216 WDP_LOGE("Failed to get system bus");
4220 message = dbus_message_new_method_call(NETCONFIG_SERVICE,
4221 NETCONFIG_WIFI_PATH, NETCONFIG_WIFI_INTERFACE, "RemoveP2pDriver");
4222 if (message == NULL) {
4223 WDP_LOGE("Failed DBus method call");
4224 dbus_connection_unref(connection);
4228 dbus_error_init(&error);
4230 reply = dbus_connection_send_with_reply_and_block(connection, message,
4231 NETCONFIG_DBUS_REPLY_TIMEOUT, &error);
4232 if (dbus_error_is_set(&error) == TRUE) {
4233 if (NULL != strstr(error.message, ".AlreadyExists")) {
4234 /* p2p already disabled */
4236 WDP_LOGE("dbus_connection_send_with_reply_and_block() failed. "
4237 "DBus error [%s: %s]", error.name, error.message);
4239 dbus_error_free(&error);
4242 dbus_error_free(&error);
4246 dbus_message_unref(reply);
4248 dbus_message_unref(message);
4249 dbus_connection_unref(connection);
4255 int __ws_init_p2pdevice(void)
4257 __WDP_LOG_FUNC_ENTER__;
4258 GDBusConnection *g_dbus = NULL;
4260 GVariant *value = NULL;
4261 GVariant *param = NULL;
4262 GVariantBuilder *builder = NULL;
4263 GVariantBuilder *type_builder = NULL;
4264 dbus_method_param_s params;
4266 unsigned char primary_device_type[8] = {
4267 0x00, 0x00, 0x00, 0x50,
4268 0xf2, 0x04, 0x00, 0x00
4275 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
4276 __WDP_LOG_FUNC_EXIT__;
4281 WDP_LOGE("no configurable data found");
4282 __WDP_LOG_FUNC_EXIT__;
4286 primary_device_type[1] = config->pri_dev_type;
4287 primary_device_type[7] = config->sec_dev_type;
4289 for (i = 0; i < WS_DEVTYPE_LEN; i++)
4290 WDP_LOGD("device type[%02x]", primary_device_type[i]);
4292 g_dbus = g_pd->g_dbus;
4294 WDP_LOGE("DBus connection is NULL");
4295 __WDP_LOG_FUNC_EXIT__;
4298 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
4300 dbus_set_method_param(¶ms, DBUS_PROPERTIES_METHOD_SET, g_pd->iface_path,
4303 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
4304 g_variant_builder_add(builder, "{sv}", "DeviceName",
4305 g_variant_new_string(config->device_name));
4307 g_variant_builder_add(builder, "{sv}", "GOIntent",
4308 g_variant_new_uint32(config->go_intent));
4310 g_variant_builder_add(builder, "{sv}", "PersistentReconnect",
4311 g_variant_new_boolean(config->persistent_reconnect));
4313 g_variant_builder_add(builder, "{sv}", "ListenRegClass",
4314 g_variant_new_uint32(config->listen_reg_class));
4316 g_variant_builder_add(builder, "{sv}", "ListenChannel",
4317 g_variant_new_uint32(config->listen_channel));
4319 g_variant_builder_add(builder, "{sv}", "OperRegClass",
4320 g_variant_new_uint32(config->operating_reg_class));
4322 g_variant_builder_add(builder, "{sv}", "OperChannel",
4323 g_variant_new_uint32(config->operating_channel));
4325 g_variant_builder_add(builder, "{sv}", "SsidPostfix",
4326 g_variant_new_string(config->device_name));
4328 g_variant_builder_add(builder, "{sv}", "NoGroupIface",
4329 g_variant_new_boolean(config->no_group_iface));
4331 type_builder = g_variant_builder_new(G_VARIANT_TYPE("ay"));
4332 for (i = 0; i < WS_DEVTYPE_LEN; i++)
4333 g_variant_builder_add(type_builder, "y", primary_device_type[i]);
4334 g_variant_builder_add(builder, "{sv}", "PrimaryDeviceType",
4335 g_variant_new("ay", type_builder));
4336 g_variant_builder_unref(type_builder);
4337 value = g_variant_new("a{sv}", builder);
4338 g_variant_builder_unref(builder);
4340 param = g_variant_new("(ssv)", SUPPLICANT_P2PDEVICE, "P2PDeviceConfig", value);
4342 params.params = param;
4343 DEBUG_G_VARIANT("Params : ", params.params);
4345 res = dbus_method_call(¶ms, DBUS_PROPERTIES_INTERFACE, NULL, NULL);
4347 WDP_LOGE("Failed to send command to wpa_supplicant");
4349 WDP_LOGD("Succeeded to initialize p2pdevice");
4350 __WDP_LOG_FUNC_EXIT__;
4354 int __ws_set_config_methods(void)
4356 __WDP_LOG_FUNC_ENTER__;
4357 GDBusConnection *g_dbus = NULL;
4359 GVariant *value = NULL;
4360 GVariant *param = NULL;
4362 dbus_method_param_s params;
4366 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
4367 __WDP_LOG_FUNC_EXIT__;
4372 WDP_LOGE("no configurable data found");
4373 __WDP_LOG_FUNC_EXIT__;
4377 g_dbus = g_pd->g_dbus;
4379 WDP_LOGE("DBus connection is NULL");
4380 __WDP_LOG_FUNC_EXIT__;
4383 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
4385 dbus_set_method_param(¶ms, DBUS_PROPERTIES_METHOD_SET, g_pd->iface_path,
4388 value = g_variant_new_string(config->config_methods);
4390 param = g_variant_new("(ssv)", SUPPLICANT_WPS, "ConfigMethods", value);
4391 params.params = param;
4393 res = dbus_method_call(¶ms, DBUS_PROPERTIES_INTERFACE, NULL, NULL);
4395 WDP_LOGE("Failed to send command to wpa_supplicant");
4397 WDP_LOGD("Succeeded to set config method(%s)", config->config_methods);
4399 __WDP_LOG_FUNC_EXIT__;
4403 int ws_activate(int concurrent)
4405 __WDP_LOG_FUNC_ENTER__;
4407 int retry_count = 0;
4410 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
4411 __WDP_LOG_FUNC_EXIT__;
4416 WDP_LOGE("no configurable data found");
4417 __WDP_LOG_FUNC_EXIT__;
4421 res = __ws_p2p_supplicant_start();
4423 res = __ws_p2p_supplicant_stop();
4424 WDP_LOGI("P2P supplicant stopped with error %d", res);
4425 __WDP_LOG_FUNC_EXIT__;
4429 while (retry_count < WS_CONN_RETRY_COUNT) {
4430 /* load wlan driver */
4431 if (concurrent == 0)
4432 res = __ws_p2p_firmware_start(config->ifname);
4434 WDP_LOGE("Failed to load driver [ret=%d]", res);
4437 WDP_LOGI("P2P firmware started with error %d", res);
4439 if (__ws_check_net_interface(config->ifname) < 0) {
4440 usleep(150000); /* wait for 150ms */
4443 WDP_LOGE("interface is not up: retry, %d", retry_count);
4449 if (retry_count >= WS_CONN_RETRY_COUNT) {
4450 WDP_LOGE("Driver loading is failed [%d]", res);
4451 __WDP_LOG_FUNC_EXIT__;
4454 if (retry_count > 0) {
4455 /* Give driver marginal time to config net */
4456 WDP_LOGE("Driver loading is done. Wait marginal time for driver");
4460 g_pd->concurrent = concurrent;
4462 res = _ws_init_dbus_connection();
4464 _ws_deinit_dbus_connection();
4465 res = __ws_p2p_supplicant_stop();
4466 WDP_LOGI("[/usr/sbin/p2p_supp.sh stop] returns %d", res);
4467 res = __ws_p2p_firmware_stop(config->ifname);
4468 WDP_LOGI("P2P firmware stopped with error %d", res);
4469 __WDP_LOG_FUNC_EXIT__;
4473 g_pd->activated = TRUE;
4474 __ws_init_p2pdevice();
4475 __ws_set_config_methods();
4478 __WDP_LOG_FUNC_EXIT__;
4482 int ws_deactivate(int concurrent)
4484 __WDP_LOG_FUNC_ENTER__;
4485 wfd_oem_asp_service_s *data = NULL;
4489 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
4490 __WDP_LOG_FUNC_EXIT__;
4495 WDP_LOGE("no configurable data found");
4496 __WDP_LOG_FUNC_EXIT__;
4500 if (!g_pd->activated) {
4501 WDP_LOGE("Wi-Fi Direct is not activated");
4502 __WDP_LOG_FUNC_EXIT__;
4508 g_pd->concurrent = concurrent;
4510 if (g_strcmp0(config->ifname, config->group_ifname) != 0)
4511 _ws_get_interface(config->group_ifname, __ws_remove_interface, NULL);
4512 if (concurrent == 0)
4513 _ws_get_interface(config->ifname, __ws_remove_interface, NULL);
4515 _ws_deinit_dbus_connection();
4517 if (concurrent == 0) {
4518 res = __ws_p2p_supplicant_stop();
4519 WDP_LOGI("[/usr/sbin/p2p_supp.sh stop] returns %d", res);
4520 res = __ws_p2p_firmware_stop(config->ifname);
4521 WDP_LOGI("P2P firmware stopped with error %d", res);
4523 g_pd->activated = FALSE;
4525 GLIST_ITER_START(seek_list, data)
4528 temp = g_list_next(seek_list);
4529 seek_list = g_list_remove(seek_list, data);
4530 g_free(data->service_type);
4531 g_free(data->service_info);
4536 __WDP_LOG_FUNC_EXIT__;
4541 static gboolean _retry_start_scan(gpointer data)
4543 __WDP_LOG_FUNC_ENTER__;
4545 WDP_LOGD("Succeeded to start scan");
4547 __WDP_LOG_FUNC_EXIT__;
4552 static void __ws_add_seek_params(GVariantBuilder *builder)
4554 GVariantBuilder *outter = NULL;
4555 GVariantBuilder *inner = NULL;
4556 wfd_oem_asp_service_s *data = NULL;
4560 if (seek_list == NULL || g_list_length(seek_list) == 0) {
4561 WDP_LOGD("seek list is NULL");
4564 WDP_LOGD("seek list length [%d]", g_list_length(seek_list));
4566 outter = g_variant_builder_new(G_VARIANT_TYPE("aay"));
4568 GLIST_ITER_START(seek_list, data)
4569 if (data && data->service_type) {
4570 len = strlen(data->service_type) + 1;
4571 WDP_LOGD("data [%s] len [%d]", data->service_type, len);
4572 inner = g_variant_builder_new(G_VARIANT_TYPE("ay"));
4573 for (i = 0; i < len; i++)
4574 g_variant_builder_add(inner, "y", data->service_type[i]);
4575 g_variant_builder_add(outter, "ay", inner);
4576 g_variant_builder_unref(inner);
4579 g_variant_builder_add(builder, "{sv}", "Seek", g_variant_new("aay", outter));
4580 g_variant_builder_unref(outter);
4585 int ws_start_scan(wfd_oem_scan_param_s *param)
4587 __WDP_LOG_FUNC_ENTER__;
4588 GDBusConnection *g_dbus = NULL;
4589 GVariantBuilder *builder = NULL;
4590 GVariant *value = NULL;
4591 dbus_method_param_s params;
4595 WDP_LOGE("Invalid parameter");
4596 __WDP_LOG_FUNC_EXIT__;
4601 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
4602 __WDP_LOG_FUNC_EXIT__;
4606 g_dbus = g_pd->g_dbus;
4608 WDP_LOGE("DBus connection is NULL");
4609 __WDP_LOG_FUNC_EXIT__;
4612 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
4614 if (param->scan_mode == WFD_OEM_SCAN_MODE_ACTIVE) {
4616 dbus_set_method_param(¶ms, "Find", g_pd->iface_path, g_dbus);
4618 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
4620 if (param->scan_time)
4621 g_variant_builder_add(builder, "{sv}", "Timeout",
4622 g_variant_new_int32(param->scan_time));
4623 if (param->scan_type == WFD_OEM_SCAN_TYPE_SOCIAL)
4624 g_variant_builder_add(builder, "{sv}", "DiscoveryType",
4625 g_variant_new_string("social"));
4626 if (seek_list != NULL)
4627 __ws_add_seek_params(builder);
4629 value = g_variant_new("(a{sv})", builder);
4630 g_variant_builder_unref(builder);
4633 dbus_set_method_param(¶ms, "Listen", g_pd->iface_path, g_dbus);
4634 value = g_variant_new("(i)", param->scan_time);
4637 params.params = value;
4638 DEBUG_G_VARIANT("Params : ", params.params);
4640 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
4642 WDP_LOGE("Failed to send command to wpa_supplicant");
4644 WDP_LOGD("Succeeded to start scan");
4646 __WDP_LOG_FUNC_EXIT__;
4650 int ws_restart_scan(int freq)
4652 __WDP_LOG_FUNC_ENTER__;
4653 GDBusConnection *g_dbus = NULL;
4654 GVariantBuilder *builder = NULL;
4655 GVariant *value = NULL;
4656 dbus_method_param_s params;
4660 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
4661 __WDP_LOG_FUNC_EXIT__;
4665 g_dbus = g_pd->g_dbus;
4667 WDP_LOGE("DBus connection is NULL");
4668 __WDP_LOG_FUNC_EXIT__;
4671 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
4673 dbus_set_method_param(¶ms, "Find", g_pd->iface_path, g_dbus);
4675 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
4676 g_variant_builder_add(builder, "{sv}", "Timeout", g_variant_new_int32(2));
4677 g_variant_builder_add(builder, "{sv}", "DiscoveryType",
4678 g_variant_new_string("social"));
4679 value = g_variant_new("(a{sv})", builder);
4680 g_variant_builder_unref(builder);
4682 params.params = value;
4683 DEBUG_G_VARIANT("Params : ", params.params);
4685 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
4687 WDP_LOGE("Failed to send command to wpa_supplicant");
4689 WDP_LOGD("Succeeded to start scan");
4691 __WDP_LOG_FUNC_EXIT__;
4695 int ws_stop_scan(void)
4697 __WDP_LOG_FUNC_ENTER__;
4698 GDBusConnection *g_dbus = NULL;
4699 dbus_method_param_s params;
4703 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
4704 __WDP_LOG_FUNC_EXIT__;
4708 g_dbus = g_pd->g_dbus;
4710 WDP_LOGE("DBus connection is NULL");
4711 __WDP_LOG_FUNC_EXIT__;
4714 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
4716 dbus_set_method_param(¶ms, "StopFind", g_pd->iface_path, g_dbus);
4717 params.params = NULL;
4719 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
4721 WDP_LOGE("Failed to send command to wpa_supplicant");
4723 WDP_LOGD("Succeeded to stop scan");
4725 __WDP_LOG_FUNC_EXIT__;
4729 int ws_get_visibility(int *visibility)
4731 __WDP_LOG_FUNC_ENTER__;
4733 __WDP_LOG_FUNC_EXIT__;
4737 int ws_set_visibility(int visibility)
4739 __WDP_LOG_FUNC_ENTER__;
4741 __WDP_LOG_FUNC_EXIT__;
4745 int ws_get_scan_result(GList **peers, int *peer_count)
4747 __WDP_LOG_FUNC_ENTER__;
4749 __WDP_LOG_FUNC_EXIT__;
4752 static wfd_oem_device_s *__create_oem_device(void)
4754 wfd_oem_device_s *device =
4755 (wfd_oem_device_s *) g_try_malloc0(sizeof(wfd_oem_device_s));
4757 char error_buf[MAX_SIZE_ERROR_BUFFER] = {0, };
4758 strerror_r(errno, error_buf, MAX_SIZE_ERROR_BUFFER);
4759 WDP_LOGF("Failed to allocate memory for event. [%s]",
4766 int ws_get_peer_info(unsigned char *peer_addr, wfd_oem_device_s **peer)
4768 __WDP_LOG_FUNC_ENTER__;
4769 GDBusConnection *g_dbus = NULL;
4770 wfd_oem_device_s *device = NULL;
4771 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
4774 if (!peer_addr || !peer) {
4775 WDP_LOGE("Invalid parameter");
4776 __WDP_LOG_FUNC_EXIT__;
4781 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
4782 __WDP_LOG_FUNC_EXIT__;
4786 g_dbus = g_pd->g_dbus;
4788 WDP_LOGE("DBus connection is NULL");
4789 __WDP_LOG_FUNC_EXIT__;
4793 device = __create_oem_device();
4795 __WDP_LOG_FUNC_EXIT__;
4799 g_snprintf(peer_path, DBUS_OBJECT_PATH_MAX, "%s/Peers/"
4800 COMPACT_MACSTR, g_pd->iface_path, MAC2STR(peer_addr));
4802 WDP_LOGD("get peer path [%s]", peer_path);
4804 res = dbus_property_get_all(peer_path, g_dbus, SUPPLICANT_P2P_PEER,
4805 __ws_get_peer_property, device);
4808 WDP_LOGE("Failed to send command to wpa_supplicant");
4810 g_free(device->vsie);
4812 __WDP_LOG_FUNC_EXIT__;
4815 WDP_LOGD("succeeded to get peer info");
4819 //Memory ownership of dev_data is transferred to method handler
4820 //which uses this function.
4822 __WDP_LOG_FUNC_EXIT__;
4826 int ws_prov_disc_req(unsigned char *peer_addr, wfd_oem_wps_mode_e wps_mode, int join)
4828 __WDP_LOG_FUNC_ENTER__;
4829 GDBusConnection *g_dbus = NULL;
4830 GVariant *value = NULL;
4831 dbus_method_param_s params;
4832 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
4836 WDP_LOGE("Invalid parameter");
4837 __WDP_LOG_FUNC_EXIT__;
4842 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
4843 __WDP_LOG_FUNC_EXIT__;
4847 g_dbus = g_pd->g_dbus;
4849 WDP_LOGE("DBus connection is NULL");
4850 __WDP_LOG_FUNC_EXIT__;
4853 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
4855 dbus_set_method_param(¶ms, "ProvisionDiscoveryRequest", g_pd->iface_path, g_dbus);
4857 g_snprintf(peer_path, DBUS_OBJECT_PATH_MAX, "%s/Peers/"
4858 COMPACT_MACSTR, g_pd->iface_path, MAC2STR(peer_addr));
4859 WDP_LOGD("get peer path [%s]", peer_path);
4861 value = g_variant_new("(os)", peer_path, __ws_wps_to_txt(wps_mode));
4863 params.params = value;
4864 DEBUG_G_VARIANT("Params : ", params.params);
4866 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
4868 WDP_LOGE("Failed to send command to wpa_supplicant");
4870 WDP_LOGD("Succeeded to send prov disc to peer[" MACSTR "]", MAC2STR(peer_addr));
4872 __WDP_LOG_FUNC_EXIT__;
4876 int ws_connect(unsigned char *peer_addr, wfd_oem_conn_param_s *param)
4878 __WDP_LOG_FUNC_ENTER__;
4879 GDBusConnection *g_dbus = NULL;
4880 GVariantBuilder *builder = NULL;
4881 GVariant *value = NULL;
4882 dbus_method_param_s params;
4883 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
4886 if (!peer_addr || !param) {
4887 WDP_LOGE("Invalid parameter");
4888 __WDP_LOG_FUNC_EXIT__;
4893 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
4894 __WDP_LOG_FUNC_EXIT__;
4898 g_dbus = g_pd->g_dbus;
4900 WDP_LOGE("DBus connection is NULL");
4901 __WDP_LOG_FUNC_EXIT__;
4904 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
4906 dbus_set_method_param(¶ms, "Connect", g_pd->iface_path, g_dbus);
4908 g_snprintf(peer_path, DBUS_OBJECT_PATH_MAX, "%s/Peers/"
4909 COMPACT_MACSTR, g_pd->iface_path, MAC2STR(peer_addr));
4910 WDP_LOGD("get peer path [%s]", peer_path);
4912 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
4913 g_variant_builder_add(builder, "{sv}", "peer", g_variant_new_object_path(peer_path));
4914 if (param->conn_flags & WFD_OEM_CONN_TYPE_PERSISTENT)
4915 g_variant_builder_add(builder, "{sv}", "persistent", g_variant_new_boolean(TRUE));
4917 if (param->conn_flags & WFD_OEM_CONN_TYPE_JOIN)
4918 g_variant_builder_add(builder, "{sv}", "join", g_variant_new_boolean(TRUE));
4920 if (param->conn_flags & WFD_OEM_CONN_TYPE_AUTH)
4921 g_variant_builder_add(builder, "{sv}", "autorize_only", g_variant_new_boolean(TRUE));
4923 if (param->wps_pin[0] != '\0')
4924 g_variant_builder_add(builder, "{sv}", "pin", g_variant_new_string(param->wps_pin));
4926 g_variant_builder_add(builder, "{sv}", "wps_method",
4927 g_variant_new_string(__ws_wps_to_txt(param->wps_mode)));
4929 value = g_variant_new("(a{sv})", builder);
4930 g_variant_builder_unref(builder);
4932 params.params = value;
4933 DEBUG_G_VARIANT("Params : ", params.params);
4935 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
4937 WDP_LOGE("Failed to send command to wpa_supplicant");
4939 WDP_LOGD("Succeeded to send connection command to peer[" MACSTR "]", MAC2STR(peer_addr));
4941 __WDP_LOG_FUNC_EXIT__;
4945 int ws_disconnect(unsigned char *peer_addr, int is_iface_addr)
4947 __WDP_LOG_FUNC_ENTER__;
4948 GDBusConnection *g_dbus = NULL;
4949 GVariant *value = NULL;
4950 dbus_method_param_s params;
4951 GVariantBuilder *builder = NULL;
4955 WDP_LOGE("Invalid parameter");
4956 __WDP_LOG_FUNC_EXIT__;
4961 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
4962 __WDP_LOG_FUNC_EXIT__;
4966 g_dbus = g_pd->g_dbus;
4968 WDP_LOGE("DBus connection is NULL");
4969 __WDP_LOG_FUNC_EXIT__;
4972 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
4974 dbus_set_method_param(¶ms, "RemoveClient", g_pd->iface_path, g_dbus);
4975 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
4977 if (is_iface_addr) {
4978 char peer_mac_str[WS_MACSTR_LEN] = {'\0', };
4980 g_snprintf(peer_mac_str, WS_MACSTR_LEN, MACSTR, MAC2STR(peer_addr));
4981 WDP_LOGI("peer addr [%s]", peer_mac_str);
4982 g_variant_builder_add(builder, "{sv}", "iface",
4983 g_variant_new_string(peer_mac_str));
4985 char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0', };
4987 g_snprintf(peer_path, DBUS_OBJECT_PATH_MAX, "%s/Peers/"
4988 COMPACT_MACSTR, g_pd->iface_path, MAC2STR(peer_addr));
4989 g_variant_builder_add(builder, "{sv}", "peer",
4990 g_variant_new_object_path(peer_path));
4993 value = g_variant_new("(a{sv})", builder);
4994 g_variant_builder_unref(builder);
4996 params.params = value;
4997 DEBUG_G_VARIANT("Params : ", params.params);
4999 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
5001 WDP_LOGE("Failed to send command to wpa_supplicant");
5003 WDP_LOGD("Succeeded to send disconnection command to peer[" MACSECSTR "]",
5004 MAC2SECSTR(peer_addr));
5006 __WDP_LOG_FUNC_EXIT__;
5010 int ws_reject_connection(unsigned char *peer_addr)
5012 __WDP_LOG_FUNC_ENTER__;
5013 GDBusConnection *g_dbus = NULL;
5014 GVariant *value = NULL;
5015 dbus_method_param_s params;
5016 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
5020 WDP_LOGE("Invalid parameter");
5021 __WDP_LOG_FUNC_EXIT__;
5026 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
5027 __WDP_LOG_FUNC_EXIT__;
5031 g_dbus = g_pd->g_dbus;
5033 WDP_LOGE("DBus connection is NULL");
5034 __WDP_LOG_FUNC_EXIT__;
5037 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
5039 dbus_set_method_param(¶ms, "RejectPeer", g_pd->iface_path, g_dbus);
5041 g_snprintf(peer_path, DBUS_OBJECT_PATH_MAX, "%s/Peers/"
5042 COMPACT_MACSTR, g_pd->iface_path, MAC2STR(peer_addr));
5043 WDP_LOGE("get peer path [%s]", peer_path);
5045 value = g_variant_new("(o)", peer_path);
5047 params.params = value;
5048 DEBUG_G_VARIANT("Params : ", params.params);
5050 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
5052 WDP_LOGE("Failed to send command to wpa_supplicant");
5054 WDP_LOGD("Succeeded to reject peer[" MACSTR "]", MAC2STR(peer_addr));
5057 __WDP_LOG_FUNC_EXIT__;
5061 int ws_cancel_connection(unsigned char *peer_addr)
5063 __WDP_LOG_FUNC_ENTER__;
5067 __WDP_LOG_FUNC_EXIT__;
5071 int ws_get_connected_peers(GList **peers, int *peer_count)
5073 __WDP_LOG_FUNC_ENTER__;
5075 __WDP_LOG_FUNC_EXIT__;
5079 int ws_get_pin(char *pin)
5081 __WDP_LOG_FUNC_ENTER__;
5083 __WDP_LOG_FUNC_EXIT__;
5087 int ws_set_pin(char *pin)
5089 __WDP_LOG_FUNC_ENTER__;
5091 __WDP_LOG_FUNC_EXIT__;
5095 static void __ws_get_pin(GVariant *value, void *user_data)
5097 __WDP_LOG_FUNC_ENTER__;
5098 const char *pin = NULL;
5100 g_variant_get(value, "(&s)", &pin);
5101 g_strlcpy((char *)user_data, pin, OEM_PINSTR_LEN + 1);
5103 __WDP_LOG_FUNC_EXIT__;
5107 int ws_generate_pin(char **pin)
5109 __WDP_LOG_FUNC_ENTER__;
5110 GDBusConnection *g_dbus = NULL;
5111 dbus_method_param_s params;
5112 char n_pin[9] = {0,};
5116 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
5120 g_dbus = g_pd->g_dbus;
5122 WDP_LOGE("DBus connection is NULL");
5125 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
5127 dbus_set_method_param(¶ms, "GeneratePin", g_pd->iface_path, g_dbus);
5128 params.params = NULL;
5130 res = dbus_method_call(¶ms, SUPPLICANT_WPS, __ws_get_pin, (void *)n_pin);
5132 WDP_LOGE("Failed to send command to wpa_supplicant");
5134 WDP_LOGD("Succeeded to generate_pin [ %s ]", n_pin);
5136 *pin = strndup(n_pin, OEM_PINSTR_LEN);
5137 __WDP_LOG_FUNC_EXIT__;
5141 int ws_get_supported_wps_mode(int *wps_mode)
5143 __WDP_LOG_FUNC_ENTER__;
5145 WDP_LOGE("Invalid parameter");
5146 __WDP_LOG_FUNC_EXIT__;
5150 *wps_mode = wps_config_method;
5151 __WDP_LOG_FUNC_EXIT__;
5155 int _ws_get_persistent_net_id(int *persistent_network_id, const unsigned char *go_dev_mac)
5157 __WDP_LOG_FUNC_ENTER__;
5158 int persistent_group_count = 0;
5162 wfd_oem_persistent_group_s *plist = NULL;
5164 res = ws_get_persistent_groups(&plist, &persistent_group_count);
5166 WDP_LOGE("failed to get persistent groups");
5167 __WDP_LOG_FUNC_EXIT__;
5171 if (persistent_group_count > WS_MAX_PERSISTENT_COUNT) {
5172 WDP_LOGE("persistent group count greater than max Persistent count");
5173 persistent_group_count = WS_MAX_PERSISTENT_COUNT;
5176 WDP_LOGD("Persistent Group Count=%d", persistent_group_count);
5178 for (counter = 0; counter < persistent_group_count ; counter++) {
5179 if (!memcmp(go_dev_mac, plist[counter].go_mac_address, WS_MACADDR_LEN)) {
5180 *persistent_network_id = plist[counter].network_id;
5183 WDP_LOGD("Invite: Persistent GO[" MACSTR "], GO Addr[" MACSTR "]",
5184 MAC2STR(plist[counter].go_mac_address), MAC2STR(go_dev_mac));
5190 WDP_LOGD("persistent network ID : [%d]", *persistent_network_id);
5192 __WDP_LOG_FUNC_EXIT__;
5196 static void __store_group_iface_path(GVariant* value, void* user_data)
5198 __WDP_LOG_FUNC_ENTER__;
5199 ws_dbus_plugin_data_s * pd_data;
5200 const char *path = NULL;
5203 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
5207 pd_data = (ws_dbus_plugin_data_s *) g_pd;
5209 g_variant_get(value, "(&o)", &path);
5210 g_strlcpy(pd_data->group_iface_path, path, DBUS_OBJECT_PATH_MAX);
5212 WDP_LOGD("group object path [%s]", pd_data->group_iface_path);
5213 /* subscribe interface p2p signal */
5216 int ws_create_group(wfd_oem_group_param_s *param)
5218 __WDP_LOG_FUNC_ENTER__;
5219 GDBusConnection *g_dbus = NULL;
5220 GVariantBuilder *builder = NULL;
5221 GVariant *value = NULL;
5222 dbus_method_param_s params;
5223 char persistent_group_obj_path[OBJECT_PATH_MAX] = {0,};
5227 WDP_LOGE("Invalid parameter");
5228 __WDP_LOG_FUNC_EXIT__;
5233 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
5234 __WDP_LOG_FUNC_EXIT__;
5238 g_dbus = g_pd->g_dbus;
5240 WDP_LOGE("DBus connection is NULL");
5241 __WDP_LOG_FUNC_EXIT__;
5244 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
5246 dbus_set_method_param(¶ms, "GroupAdd", g_pd->iface_path, g_dbus);
5248 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
5250 if (param->persistent > 0) {
5251 unsigned char mac_address[WS_MACADDR_LEN] = {0x00, };
5252 int persistent_group_id = -1;
5254 res = _ws_get_local_dev_mac(mac_address);
5256 WDP_LOGE("failed to get local mac address");
5257 __WDP_LOG_FUNC_EXIT__;
5261 res = _ws_get_persistent_net_id(&persistent_group_id, mac_address);
5263 WDP_LOGE("failed to get persistent group ID");
5264 __WDP_LOG_FUNC_EXIT__;
5268 WDP_LOGD("persistent network ID : [%d]", persistent_group_id);
5270 g_variant_builder_add(builder, "{sv}", "persistent",
5271 g_variant_new_boolean(TRUE));
5272 if (persistent_group_id > -1) {
5273 g_snprintf(persistent_group_obj_path, OBJECT_PATH_MAX,
5274 "%s/" SUPPLICANT_PERSISTENT_GROUPS_PART "/%d",
5275 g_pd->iface_path, persistent_group_id);
5276 g_variant_builder_add(builder, "{sv}", "persistent_group_object",
5277 g_variant_new_object_path(persistent_group_obj_path));
5281 g_variant_builder_add(builder, "{sv}", "persistent",
5282 g_variant_new_boolean(FALSE));
5285 if (strlen(param->passphrase) > 0)
5286 g_variant_builder_add(builder, "{sv}", "passphrase",
5287 g_variant_new_string(param->passphrase));
5289 if (strlen(param->ssid) > 0)
5290 g_variant_builder_add(builder, "{sv}", "ssid",
5291 g_variant_new_string(param->ssid));
5294 g_variant_builder_add(builder, "{sv}", "frequency",
5295 g_variant_new_int32(param->freq));
5297 value = g_variant_new("(a{sv})", builder);
5298 g_variant_builder_unref(builder);
5300 params.params = value;
5301 DEBUG_G_VARIANT("Params : ", params.params);
5303 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE,
5304 __store_group_iface_path, g_pd);
5306 WDP_LOGE("Failed to send command to wpa_supplicant");
5308 WDP_LOGD("Succeeded to add group");
5310 __WDP_LOG_FUNC_EXIT__;
5314 int ws_destroy_group(const char *ifname)
5316 __WDP_LOG_FUNC_ENTER__;
5317 GDBusConnection *g_dbus = NULL;
5318 dbus_method_param_s params;
5322 WDP_LOGE("Invalid parameter");
5327 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
5328 __WDP_LOG_FUNC_EXIT__;
5332 g_dbus = g_pd->g_dbus;
5334 WDP_LOGE("DBus connection is NULL");
5335 __WDP_LOG_FUNC_EXIT__;
5339 if (g_pd->group_iface_path[0] == 0) {
5340 WDP_LOGE("group iface path is NULL");
5344 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
5346 dbus_set_method_param(¶ms, "Disconnect", g_pd->group_iface_path, g_dbus);
5347 params.params = NULL;
5349 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
5351 WDP_LOGE("Failed to send command to wpa_supplicant");
5352 __WDP_LOG_FUNC_EXIT__;
5356 WDP_LOGD("Succeeded to remove group");
5359 __WDP_LOG_FUNC_EXIT__;
5363 int ws_invite(unsigned char *peer_addr, wfd_oem_invite_param_s *param)
5365 __WDP_LOG_FUNC_ENTER__;
5366 GDBusConnection *g_dbus = NULL;
5367 GVariantBuilder *builder = NULL;
5368 GVariant *value = NULL;
5369 dbus_method_param_s params;
5370 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
5373 if (!peer_addr || !param) {
5374 WDP_LOGE("Invalid parameter");
5379 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
5380 __WDP_LOG_FUNC_EXIT__;
5384 g_dbus = g_pd->g_dbus;
5386 WDP_LOGE("DBus connection is NULL");
5387 __WDP_LOG_FUNC_EXIT__;
5390 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
5392 dbus_set_method_param(¶ms, "Invite", g_pd->group_iface_path, g_dbus);
5394 g_snprintf(peer_path, DBUS_OBJECT_PATH_MAX, "%s/Peers/"
5395 COMPACT_MACSTR, g_pd->iface_path, MAC2STR(peer_addr));
5396 WDP_LOGE("get peer path [%s]", peer_path);
5398 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
5399 g_variant_builder_add(builder, "{sv}", "peer", g_variant_new_object_path(peer_path));
5400 value = g_variant_new("(a{sv})", builder);
5401 g_variant_builder_unref(builder);
5403 params.params = value;
5404 DEBUG_G_VARIANT("Params : ", params.params);
5406 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
5408 WDP_LOGE("Failed to send command to wpa_supplicant");
5410 WDP_LOGD("Succeeded to invite peer[" MACSTR "]", MAC2STR(peer_addr));
5412 __WDP_LOG_FUNC_EXIT__;
5416 /* Only group owner can use this command */
5417 int ws_wps_start(unsigned char *peer_addr, int wps_mode, const char *pin)
5419 __WDP_LOG_FUNC_ENTER__;
5420 GDBusConnection *g_dbus = NULL;
5421 GVariantBuilder *builder = NULL;
5422 GVariant *value = NULL;
5423 GVariant *dev_addr = NULL;
5424 dbus_method_param_s params;
5429 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
5430 __WDP_LOG_FUNC_EXIT__;
5434 g_dbus = g_pd->g_dbus;
5436 WDP_LOGE("DBus connection is NULL");
5437 __WDP_LOG_FUNC_EXIT__;
5441 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
5443 dbus_set_method_param(¶ms, "Start", g_pd->group_iface_path, g_dbus);
5445 if (peer_addr != NULL) {
5446 builder = g_variant_builder_new(G_VARIANT_TYPE("ay"));
5447 for (i = 0; i < WS_MACADDR_LEN; i++)
5448 g_variant_builder_add(builder, "y", peer_addr[i]);
5450 dev_addr = g_variant_new("ay", builder);
5451 g_variant_builder_unref(builder);
5454 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
5455 g_variant_builder_add(builder, "{sv}", "Role", g_variant_new_string("enrollee"));
5456 if (peer_addr != NULL)
5457 g_variant_builder_add(builder, "{sv}", "P2PDeviceAddress", dev_addr);
5459 if (pin != NULL && pin[0] != '\0') {
5460 g_variant_builder_add(builder, "{sv}", "Type", g_variant_new_string("pin"));
5461 g_variant_builder_add(builder, "{sv}", "Pin", g_variant_new_string(pin));
5463 g_variant_builder_add(builder, "{sv}", "Type", g_variant_new_string("pbc"));
5466 value = g_variant_new("(a{sv})", builder);
5467 g_variant_builder_unref(builder);
5469 params.params = value;
5470 DEBUG_G_VARIANT("Params : ", params.params);
5472 res = dbus_method_call(¶ms, SUPPLICANT_WPS, NULL, NULL);
5474 WDP_LOGE("Failed to send command to wpa_supplicant");
5476 WDP_LOGD("Succeeded to run wps");
5478 __WDP_LOG_FUNC_EXIT__;
5482 int ws_enrollee_start(unsigned char *peer_addr, int wps_mode, const char *pin)
5484 __WDP_LOG_FUNC_ENTER__;
5486 WDP_LOGD("Succeeded to start WPS");
5488 __WDP_LOG_FUNC_EXIT__;
5492 int ws_wps_cancel(void)
5494 __WDP_LOG_FUNC_ENTER__;
5495 GDBusConnection *g_dbus = NULL;
5496 dbus_method_param_s params;
5499 g_dbus = g_pd->g_dbus;
5501 WDP_LOGE("DBus connection is NULL");
5502 __WDP_LOG_FUNC_EXIT__;
5505 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
5507 dbus_set_method_param(¶ms, "Cancel", g_pd->group_iface_path, g_dbus);
5508 params.params = NULL;
5510 res = dbus_method_call(¶ms, SUPPLICANT_WPS, NULL, NULL);
5512 WDP_LOGE("Failed to send command to wpa_supplicant");
5514 WDP_LOGD("Succeeded to cancel WPS");
5516 __WDP_LOG_FUNC_EXIT__;
5520 int ws_get_dev_name(char *dev_name)
5522 __WDP_LOG_FUNC_ENTER__;
5524 __WDP_LOG_FUNC_EXIT__;
5528 int ws_set_dev_name(char *dev_name)
5530 __WDP_LOG_FUNC_ENTER__;
5531 GDBusConnection *g_dbus = NULL;
5533 GVariant *value = NULL;
5534 GVariant *param = NULL;
5535 GVariantBuilder *builder = NULL;
5536 dbus_method_param_s params;
5540 WDP_LOGE("Invalid parameter");
5541 __WDP_LOG_FUNC_EXIT__;
5546 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
5547 __WDP_LOG_FUNC_EXIT__;
5551 g_dbus = g_pd->g_dbus;
5553 WDP_LOGE("DBus connection is NULL");
5554 __WDP_LOG_FUNC_EXIT__;
5557 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
5559 dbus_set_method_param(¶ms, DBUS_PROPERTIES_METHOD_SET, g_pd->iface_path,
5562 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
5563 g_variant_builder_add(builder, "{sv}", "DeviceName",
5564 g_variant_new_string(dev_name));
5565 g_variant_builder_add(builder, "{sv}", "SsidPostfix",
5566 g_variant_new_string(dev_name));
5567 value = g_variant_new("a{sv}", builder);
5568 g_variant_builder_unref(builder);
5570 param = g_variant_new("(ssv)", SUPPLICANT_P2PDEVICE,
5571 "P2PDeviceConfig", value);
5573 params.params = param;
5574 DEBUG_G_VARIANT("Params : ", params.params);
5576 res = dbus_method_call(¶ms, DBUS_PROPERTIES_INTERFACE, NULL, NULL);
5578 WDP_LOGE("Failed to send command to wpa_supplicant");
5580 WDP_LOGD("Succeeded to set device name");
5582 __WDP_LOG_FUNC_EXIT__;
5586 int ws_get_dev_mac(char *dev_mac)
5588 __WDP_LOG_FUNC_ENTER__;
5590 __WDP_LOG_FUNC_EXIT__;
5594 int ws_get_dev_type(int *pri_dev_type, int *sec_dev_type)
5596 __WDP_LOG_FUNC_ENTER__;
5598 __WDP_LOG_FUNC_EXIT__;
5602 int ws_set_dev_type(int pri_dev_type, int sec_dev_type)
5604 __WDP_LOG_FUNC_ENTER__;
5606 __WDP_LOG_FUNC_EXIT__;
5610 int ws_get_go_intent(int *go_intent)
5612 __WDP_LOG_FUNC_ENTER__;
5613 GDBusConnection *g_dbus = NULL;
5614 GVariant *param = NULL;
5615 GVariant *reply = NULL;
5616 GError *error = NULL;
5617 GVariantIter *iter = NULL;
5621 WDP_LOGE("Invalid parameter");
5626 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
5627 __WDP_LOG_FUNC_EXIT__;
5631 g_dbus = g_pd->g_dbus;
5633 WDP_LOGE("DBus connection is NULL");
5634 __WDP_LOG_FUNC_EXIT__;
5638 param = g_variant_new("(ss)", SUPPLICANT_P2PDEVICE, "P2PDeviceConfig");
5639 DEBUG_G_VARIANT("Params : ", param);
5641 reply = g_dbus_connection_call_sync(
5643 SUPPLICANT_SERVICE, /* bus name */
5644 g_pd->iface_path, /* object path */
5645 DBUS_PROPERTIES_INTERFACE, /* interface name */
5646 DBUS_PROPERTIES_METHOD_GET, /* method name */
5647 param, /* GVariant *params */
5648 NULL, /* reply_type */
5649 G_DBUS_CALL_FLAGS_NONE, /* flags */
5650 SUPPLICANT_TIMEOUT , /* timeout */
5651 NULL, /* cancellable */
5652 &error); /* error */
5654 if (error != NULL) {
5655 WDP_LOGE("Error! Failed to get interface State: [%s]",
5657 g_error_free(error);
5659 g_variant_unref(reply);
5660 __WDP_LOG_FUNC_EXIT__;
5664 if (reply != NULL) {
5665 g_variant_get(reply, "(a{sv})", &iter);
5669 GVariant *value = NULL;
5671 while (g_variant_iter_loop(iter, "{sv}", &key, &value)) {
5672 CHECK_KEY_VALUE(key, value);
5674 if (g_strcmp0(key, "GOIntent") == 0)
5675 g_variant_get(value, "u", go_intent);
5677 g_variant_iter_free(iter);
5679 g_variant_unref(reply);
5681 __WDP_LOG_FUNC_EXIT__;
5685 int ws_set_go_intent(int go_intent)
5687 __WDP_LOG_FUNC_ENTER__;
5688 GDBusConnection *g_dbus = NULL;
5690 GVariant *value = NULL;
5691 GVariant *param = NULL;
5692 GVariantBuilder *builder = NULL;
5693 dbus_method_param_s params;
5697 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
5698 __WDP_LOG_FUNC_EXIT__;
5702 g_dbus = g_pd->g_dbus;
5704 WDP_LOGE("DBus connection is NULL");
5705 __WDP_LOG_FUNC_EXIT__;
5708 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
5710 dbus_set_method_param(¶ms, DBUS_PROPERTIES_METHOD_SET, g_pd->iface_path,
5713 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
5714 g_variant_builder_add(builder, "{sv}", "GOIntent",
5715 g_variant_new_uint32(go_intent));
5716 value = g_variant_new("a{sv}", builder);
5717 g_variant_builder_unref(builder);
5719 param = g_variant_new("(ssv)", SUPPLICANT_P2PDEVICE, "P2PDeviceConfig", value);
5721 params.params = param;
5722 DEBUG_G_VARIANT("Params : ", params.params);
5724 res = dbus_method_call(¶ms, DBUS_PROPERTIES_INTERFACE, NULL, NULL);
5726 WDP_LOGE("Failed to send command to wpa_supplicant");
5728 WDP_LOGE("Succeeded to set go intent");
5729 __WDP_LOG_FUNC_EXIT__;
5733 int ws_set_country(char *ccode)
5735 __WDP_LOG_FUNC_ENTER__;
5736 __WDP_LOG_FUNC_ENTER__;
5737 GDBusConnection *g_dbus = NULL;
5739 GVariant *value = NULL;
5740 GVariant *param = NULL;
5742 dbus_method_param_s params;
5746 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
5747 __WDP_LOG_FUNC_EXIT__;
5751 g_dbus = g_pd->g_dbus;
5753 WDP_LOGE("DBus connection is NULL");
5754 __WDP_LOG_FUNC_EXIT__;
5757 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
5759 dbus_set_method_param(¶ms, DBUS_PROPERTIES_METHOD_SET, g_pd->iface_path,
5762 value = g_variant_new_string(ccode);
5764 param = g_variant_new("(ssv)", SUPPLICANT_IFACE, "Country", value);
5766 params.params = param;
5767 DEBUG_G_VARIANT("Params : ", params.params);
5769 res = dbus_method_call(¶ms, DBUS_PROPERTIES_INTERFACE, NULL, NULL);
5771 WDP_LOGE("Failed to send command to wpa_supplicant");
5773 WDP_LOGD("Succeeded to set country(%s)", ccode);
5775 __WDP_LOG_FUNC_EXIT__;
5779 void __parsing_networks(const char* key, GVariant* value, void* user_data)
5781 __WDP_LOG_FUNC_ENTER__;
5783 __WDP_LOG_FUNC_EXIT__;
5787 ws_network_info_s *network = (ws_network_info_s *)user_data;
5789 CHECK_KEY_VALUE(key, value);
5791 if (g_strcmp0(key, "ssid") == 0) {
5792 const char *ssid = NULL;
5793 g_variant_get(value, "&s", &ssid);
5794 WDP_LOGD("ssid [%s]", ssid);
5795 g_strlcpy(network->ssid, ssid + 1, WS_SSID_LEN + 1);
5796 network->ssid[strlen(ssid) - 2] = '\0';
5798 } else if (g_strcmp0(key, "bssid") == 0) {
5799 unsigned char *bssid = NULL;
5800 g_variant_get(value, "&s", &bssid);
5801 WDP_LOGD("bssid [%s]", bssid);
5802 __ws_txt_to_mac(bssid, network->bssid);
5804 } else if (g_strcmp0(key, "proto") == 0) {
5805 const char *proto = NULL;
5806 g_variant_get(value, "&s", &proto);
5807 WDP_LOGD("proto [%s]", proto);
5809 if (g_strrstr(proto, WFD_OEM_STR_PROTO_WPA) != NULL)
5810 network->proto |= WFD_OEM_PROTO_WPA;
5811 if (g_strrstr(proto, WFD_OEM_STR_PROTO_RSN) != NULL)
5812 network->proto |= WFD_OEM_PROTO_RSN;
5814 } else if (g_strcmp0(key, "key_mgmt") == 0) {
5815 const char *key_mgmt = NULL;
5816 g_variant_get(value, "&s", &key_mgmt);
5817 WDP_LOGD("key_mgmt [%s]", key_mgmt);
5819 if (g_strrstr(key_mgmt, WFD_OEM_STR_KEY_MGMT_IEEE8021X) != NULL)
5820 network->key_mgmt |= WFD_OEM_KEY_MGMT_IEEE8021X;
5821 if (g_strrstr(key_mgmt, WFD_OEM_STR_KEY_MGMT_PSK) != NULL)
5822 network->key_mgmt |= WFD_OEM_KEY_MGMT_PSK;
5823 if (g_strrstr(key_mgmt, WFD_OEM_STR_KEY_MGMT_NONE) != NULL)
5824 network->key_mgmt |= WFD_OEM_KEY_MGMT_NONE;
5826 } else if (g_strcmp0(key, "pairwise") == 0) {
5827 const char *pairwise = NULL;
5828 g_variant_get(value, "&s", &pairwise);
5829 WDP_LOGD("pairwise [%s]", pairwise);
5831 if (g_strrstr(pairwise, WFD_OEM_STR_CIPHER_NONE) != NULL)
5832 network->pairwise |= WFD_OEM_CIPHER_NONE;
5833 if (g_strrstr(pairwise, WFD_OEM_STR_CIPHER_TKIP) != NULL)
5834 network->pairwise |= WFD_OEM_CIPHER_TKIP;
5835 if (g_strrstr(pairwise, WFD_OEM_STR_CIPHER_CCMP) != NULL)
5836 network->pairwise |= WFD_OEM_CIPHER_CCMP;
5838 } else if (g_strcmp0(key, "group") == 0) {
5839 const char *group = NULL;
5840 g_variant_get(value, "&s", &group);
5841 WDP_LOGD("group [%s]", group);
5843 if (g_strrstr(group, WFD_OEM_STR_CIPHER_NONE) != NULL)
5844 network->group |= WFD_OEM_CIPHER_NONE;
5845 if (g_strrstr(group, WFD_OEM_STR_CIPHER_WEP40) != NULL)
5846 network->group |= WFD_OEM_CIPHER_WEP40;
5847 if (g_strrstr(group, WFD_OEM_STR_CIPHER_WEP104) != NULL)
5848 network->group |= WFD_OEM_CIPHER_WEP104;
5849 if (g_strrstr(group, WFD_OEM_STR_CIPHER_TKIP) != NULL)
5850 network->group |= WFD_OEM_CIPHER_TKIP;
5851 if (g_strrstr(group, WFD_OEM_STR_CIPHER_CCMP) != NULL)
5852 network->group |= WFD_OEM_CIPHER_CCMP;
5854 } else if (g_strcmp0(key, "auth_alg") == 0) {
5855 const char *auth_alg = NULL;
5856 g_variant_get(value, "&s", &auth_alg);
5857 WDP_LOGD("auth_alg [%s]", auth_alg);
5859 if (g_strrstr(auth_alg, WFD_OEM_STR_AUTH_ALG_OPEN) != NULL)
5860 network->auth_alg |= WFD_OEM_AUTH_ALG_OPEN;
5862 } else if (g_strcmp0(key, "mode") == 0) {
5863 const char *mode = NULL;
5864 g_variant_get(value, "&s", &mode);
5865 WDP_LOGD("mode [%s]", mode);
5867 if (g_strrstr(mode, WFD_OEM_STR_MODE_GC) != NULL)
5868 network->mode |= WFD_OEM_PERSISTENT_MODE_GC;
5869 if (g_strrstr(mode, WFD_OEM_STR_MODE_GO) != NULL)
5870 network->mode |= WFD_OEM_PERSISTENT_MODE_GO;
5872 } else if (g_strcmp0(key, "p2p_client_list") == 0) {
5873 const char *p2p_client_list = NULL;
5878 g_variant_get(value, "&s", &p2p_client_list);
5879 WDP_LOGD("p2p_client_list [%s]", p2p_client_list);
5880 ptr = (char *)p2p_client_list;
5881 list_len = strlen(p2p_client_list);
5882 WDP_LOGD("list_len [%d]", list_len);
5883 while (ptr && list_len >= (OEM_MACSTR_LEN - 1)) {
5884 __ws_txt_to_mac((unsigned char *)ptr, (network->p2p_client_list[num]));
5885 ptr += OEM_MACSTR_LEN;
5886 list_len -= OEM_MACSTR_LEN;
5887 if (ptr && ptr[0] == ' ') {
5892 if (num >= OEM_MAX_PEER_NUM)
5895 network->p2p_client_num = num;
5896 WDP_LOGD("p2p_client_num [%d]", network->p2p_client_num);
5901 void __ws_extract_p2pdevice_details(const char *key, GVariant *value, void *user_data)
5903 __WDP_LOG_FUNC_ENTER__;
5904 CHECK_KEY_VALUE(key, value);
5906 if (g_strcmp0(key, "PersistentGroups") == 0) {
5907 GVariantIter *iter = NULL;
5908 const char *path = NULL;
5911 ws_network_info_s *networks = NULL;
5912 networks = (ws_network_info_s *)user_data;
5914 WDP_LOGE("network is NULL");
5915 __WDP_LOG_FUNC_EXIT__;
5919 g_variant_get(value, "ao", &iter);
5920 while (g_variant_iter_loop(iter, "&o", &path)) {
5923 if (num >= WS_MAX_PERSISTENT_COUNT)
5926 WDP_LOGD("Retrive persistent path [%s]", path);
5927 g_strlcpy(networks[num].persistent_path, path, DBUS_OBJECT_PATH_MAX);
5929 loc = strrchr(networks[num].persistent_path, '/');
5931 networks[num].network_id = strtoul(loc+1, NULL, 10);
5933 WDP_LOGD("Retrive persistent path [%s]", networks[num].persistent_path);
5934 dbus_property_get_all(networks[num].persistent_path, g_pd->g_dbus,
5935 SUPPLICANT_P2P_PERSISTENTGROUP, __parsing_networks, &networks[num]);
5939 networks[0].total = num;
5940 WDP_LOGI("total number [%d]", num);
5941 g_variant_iter_free(iter);
5943 __WDP_LOG_FUNC_EXIT__;
5947 int ws_get_persistent_groups(wfd_oem_persistent_group_s **groups, int *group_count)
5949 __WDP_LOG_FUNC_ENTER__;
5950 GDBusConnection *g_dbus = NULL;
5952 ws_network_info_s networks[WS_MAX_PERSISTENT_COUNT];
5953 wfd_oem_persistent_group_s *wfd_persistent_groups = NULL;
5957 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
5958 __WDP_LOG_FUNC_EXIT__;
5962 g_dbus = g_pd->g_dbus;
5964 WDP_LOGE("DBus connection is NULL");
5965 __WDP_LOG_FUNC_EXIT__;
5969 memset(&networks, 0x0, WS_MAX_PERSISTENT_COUNT * sizeof(ws_network_info_s));
5970 dbus_property_get_all(g_pd->iface_path, g_dbus, SUPPLICANT_P2PDEVICE,
5971 __ws_extract_p2pdevice_details, &networks[0]);
5973 cnt = networks[0].total;
5975 WDP_LOGD("Persistent Group Count=%d", cnt);
5976 if (cnt > WS_MAX_PERSISTENT_COUNT) {
5977 WDP_LOGE("Persistent group count exceeded or parsing error");
5978 __WDP_LOG_FUNC_EXIT__;
5983 WDP_LOGE("Persistent group count zero");
5986 __WDP_LOG_FUNC_EXIT__;
5990 wfd_persistent_groups = (wfd_oem_persistent_group_s *) g_try_malloc0(cnt * sizeof(wfd_oem_persistent_group_s));
5991 if (wfd_persistent_groups == NULL) {
5992 WDP_LOGE("Failed to allocate memory for wfd_persistent_groups ");
5993 __WDP_LOG_FUNC_EXIT__;
5997 for (i = 0; i < cnt; i++) {
6000 WDP_LOGD("----persistent group [%d]----", i);
6001 WDP_LOGD("network_id [%d]", networks[i].network_id);
6002 WDP_LOGD("ssid [%s]", networks[i].ssid);
6003 WDP_LOGD("bssid ["MACSTR"]", MAC2STR(networks[i].bssid));
6004 WDP_LOGD("p2p_client_num [%d]", networks[i].p2p_client_num);
6005 for (j = 0; j < networks[i].p2p_client_num; j++)
6006 WDP_LOGD("p2p_client_list ["MACSTR"]", MAC2STR(networks[i].p2p_client_list[j]));
6008 wfd_persistent_groups[i].network_id = networks[i].network_id;
6009 g_strlcpy(wfd_persistent_groups[i].ssid, networks[i].ssid, WS_SSID_LEN + 1);
6010 memcpy(wfd_persistent_groups[i].go_mac_address, networks[i].bssid, WS_MACADDR_LEN);
6011 wfd_persistent_groups[i].p2p_client_num = networks[i].p2p_client_num;
6012 if (wfd_persistent_groups[i].p2p_client_num > 0)
6013 memcpy(wfd_persistent_groups[i].p2p_client_list, networks[i].p2p_client_list,
6014 OEM_MACADDR_LEN * OEM_MAX_PEER_NUM * sizeof(char));
6018 *groups = wfd_persistent_groups;
6020 __WDP_LOG_FUNC_EXIT__;
6024 int ws_remove_persistent_group(char *ssid, unsigned char *bssid)
6026 __WDP_LOG_FUNC_ENTER__;
6027 GDBusConnection *g_dbus = NULL;
6029 dbus_method_param_s params;
6030 ws_network_info_s networks[WS_MAX_PERSISTENT_COUNT];
6035 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
6036 __WDP_LOG_FUNC_EXIT__;
6040 g_dbus = g_pd->g_dbus;
6042 WDP_LOGE("DBus connection is NULL");
6043 __WDP_LOG_FUNC_EXIT__;
6046 memset(&networks, 0x0, WS_MAX_PERSISTENT_COUNT * sizeof(ws_network_info_s));
6047 dbus_property_get_all(g_pd->iface_path, g_dbus, SUPPLICANT_P2PDEVICE,
6048 __ws_extract_p2pdevice_details, networks);
6050 cnt = networks[0].total;
6052 WDP_LOGD("Persistent Group Count=%d", cnt);
6053 if (cnt > WS_MAX_PERSISTENT_COUNT) {
6054 WDP_LOGE("Persistent group count exceeded or parsing error");
6055 __WDP_LOG_FUNC_EXIT__;
6059 for (i = 0; i < cnt; i++) {
6062 WDP_LOGD("----persistent group [%d]----", i);
6063 WDP_LOGD("network_id [%d]", networks[i].network_id);
6064 WDP_LOGD("network ssid [%s]", networks[i].ssid);
6065 WDP_LOGD("network bssid ["MACSTR"]", MAC2STR(networks[i].bssid));
6066 WDP_LOGD("network p2p_client_num [%d]", networks[i].p2p_client_num);
6067 for (j = 0; j < networks[i].p2p_client_num; j++)
6068 WDP_LOGD("network p2p_client_list ["MACSTR"]",
6069 MAC2STR(networks[i].p2p_client_list[j]));
6071 WDP_LOGD("ssid [%s]", ssid);
6072 WDP_LOGD("bssid ["MACSTR"]", MAC2STR(bssid));
6074 if (!g_strcmp0(ssid, networks[i].ssid) &&
6075 !memcmp(bssid, networks[i].bssid, WS_MACADDR_LEN)) {
6076 WDP_LOGD("Persistent group owner found [%d: %s]",
6077 networks[i].network_id, ssid);
6079 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
6080 dbus_set_method_param(¶ms, "RemovePersistentGroup",
6081 g_pd->iface_path, g_dbus);
6082 params.params = g_variant_new("(o)", networks[i].persistent_path);
6083 DEBUG_G_VARIANT("Params : ", params.params);
6085 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
6087 WDP_LOGE("Failed to send command to wpa_supplicant");
6088 __WDP_LOG_FUNC_EXIT__;
6092 WDP_LOGD("Succeeded to remove persistent group");;
6098 WDP_LOGE("Persistent group not found [%s]", ssid);
6102 __WDP_LOG_FUNC_EXIT__;
6106 int ws_set_persistent_reconnect(unsigned char *bssid, int reconnect)
6108 __WDP_LOG_FUNC_ENTER__;
6109 GDBusConnection *g_dbus = NULL;
6111 GVariant *value = NULL;
6112 GVariant *param = NULL;
6113 GVariantBuilder *builder = NULL;
6114 dbus_method_param_s params;
6118 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
6119 __WDP_LOG_FUNC_EXIT__;
6123 g_dbus = g_pd->g_dbus;
6125 WDP_LOGE("DBus connection is NULL");
6126 __WDP_LOG_FUNC_EXIT__;
6129 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
6131 dbus_set_method_param(¶ms, DBUS_PROPERTIES_METHOD_SET, g_pd->iface_path,
6134 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
6135 g_variant_builder_add(builder, "{sv}", "PersistentReconnect",
6136 g_variant_new_boolean(reconnect));
6137 value = g_variant_new("a{sv}", builder);
6138 g_variant_builder_unref(builder);
6140 param = g_variant_new("(ssv)", SUPPLICANT_P2PDEVICE, "P2PDeviceConfig", value);
6142 params.params = param;
6143 DEBUG_G_VARIANT("Params : ", params.params);
6145 res = dbus_method_call(¶ms, DBUS_PROPERTIES_INTERFACE, NULL, NULL);
6147 WDP_LOGE("Failed to send command to wpa_supplicant");
6149 WDP_LOGD("Succeeded to set persistent reconnect");
6151 __WDP_LOG_FUNC_EXIT__;
6155 static int __ws_compress_query(char *compressed, char *query, int qtype)
6163 token = strtok_r(query, ".", &temp);
6165 if (!strcmp(token, "local")) {
6166 WDP_LOGD("Query conversion done");
6169 } else if (!strncmp(token, "_tcp", 4)) {
6170 memcpy(&compressed[length], WS_TCP_PTR_HEX, 2);
6173 } else if (!strncmp(token, "_udp", 4)) {
6174 memcpy(&compressed[length], WS_UDP_PTR_HEX, 2);
6178 WDP_LOGD("Token: [%s]", token);
6179 token_len = strlen(token);
6180 compressed[length] = token_len;
6183 memcpy(&compressed[length], token, token_len);
6184 length += token_len;
6187 token = strtok_r(NULL, ".", &temp);
6189 if (qtype == WS_QTYPE_PTR || token_num == 2)
6190 memcpy(&compressed[length], WS_PTR_TYPE_HEX, 3);
6191 else if (qtype == WS_QTYPE_TXT || token_num == 3)
6192 memcpy(&compressed[length], WS_TXT_TYPE_HEX, 3);
6195 WDP_LOGD("converted query length [%d] token num [%d]", length, token_num);
6200 static int __ws_compress_rdata(char *compressed, char *rdata, int qtype)
6207 if (qtype == WS_QTYPE_PTR) {
6209 token = strtok_r(rdata, ".", &temp);
6211 WDP_LOGD("Token: %s", token);
6212 token_len = strlen(token);
6213 compressed[length] = token_len;
6216 memcpy(&compressed[length], token, token_len);
6217 length += token_len;
6220 compressed[length] = 0xc0;
6221 compressed[length+1] = 0x27;
6224 } else if (qtype == WS_QTYPE_TXT) {
6226 token = strtok_r(rdata, ",", &temp);
6229 WDP_LOGD("Token: [%s]", token);
6231 token_len = strlen(token);
6232 compressed[length] = token_len;
6235 memcpy(&compressed[length], token, token_len);
6236 length += token_len;
6238 token = strtok_r(NULL, ",", &temp);
6241 WDP_LOGD("RDATA is NULL");
6246 int _convert_bonjour_to_args(char *query, char *rdata, GVariantBuilder *builder)
6248 GVariantBuilder *args = NULL;
6249 char compressed[256] = {0, };
6255 if (!query || !builder) {
6256 WDP_LOGE("Invalid parameter");
6259 if (!rdata || !strlen(rdata)) {
6260 WDP_LOGD("RDATA is NULL\n");
6262 temp = strstr(rdata, query);
6264 if (temp != NULL && temp - rdata > 0)
6265 qtype = WS_QTYPE_PTR;
6267 qtype = WS_QTYPE_TXT;
6271 g_variant_builder_add(builder, "{sv}", "service_type", g_variant_new_string("bonjour"));
6273 /* compress query */
6274 length = __ws_compress_query(compressed, query, qtype);
6276 args = g_variant_builder_new(G_VARIANT_TYPE("ay"));
6277 for (i = 0; i < length; i++)
6278 g_variant_builder_add(args, "y", compressed[i]);
6279 g_variant_builder_add(builder, "{sv}", "query", g_variant_new("ay", args));
6280 g_variant_builder_unref(args);
6282 memset(compressed, 0x0, 256);
6287 length = __ws_compress_rdata(compressed, rdata, qtype);
6289 args = g_variant_builder_new(G_VARIANT_TYPE("ay"));
6290 for (i = 0; i < length; i++)
6291 g_variant_builder_add(args, "y", compressed[i]);
6292 g_variant_builder_add(builder, "{sv}", "response", g_variant_new("ay", args));
6293 g_variant_builder_unref(args);
6299 int _check_service_query_exists(wfd_oem_service_s *service)
6302 wfd_oem_service_s *data = NULL;
6304 for (count = 0; count < g_list_length(service_list); count++) {
6305 data = (wfd_oem_service_s*) g_list_nth_data(service_list, count);
6306 if (strncmp(service->query_id, data->query_id, OEM_QUERY_ID_LEN) == 0) {
6307 WDP_LOGD("Query already exists");
6314 static wfd_oem_service_s* _remove_service_query(char * s_type, char *mac_str, char *query_id)
6316 if (NULL == s_type || NULL == mac_str || NULL == query_id)
6320 wfd_oem_service_s *data = NULL;
6322 for (count = 0; count < g_list_length(service_list); count++) {
6323 data = (wfd_oem_service_s*) g_list_nth_data(service_list, count);
6324 if (data && !strncmp(data->service_type, s_type, SERVICE_TYPE_LEN) &&
6325 memcmp(data->dev_addr, mac_str, OEM_MACSTR_LEN - 1) == 0) {
6326 g_strlcpy(query_id, data->query_id, OEM_QUERY_ID_LEN + 1);
6330 if (strlen(query_id) <= 0) {
6331 WDP_LOGD("!! Query ID not found !!");
6335 WDP_LOGD("query id :[%s]", query_id);
6340 void __add_service_query(GVariant *value, void *user_data)
6342 __WDP_LOG_FUNC_ENTER__;
6343 wfd_oem_service_s *service = NULL;
6345 long long unsigned ref = 0;
6351 g_variant_get(value, "(t)", &ref);
6353 service = (wfd_oem_service_s*) g_try_malloc0(sizeof(wfd_oem_service_s));
6355 WDP_LOGE("Failed to allocate memory for service");
6359 memcpy(service, user_data, sizeof(wfd_oem_service_s));
6361 g_snprintf(service->query_id, OEM_QUERY_ID_LEN + 1, "%llx", ref);
6363 res = _check_service_query_exists(service);
6367 service_list = g_list_append(service_list, service);
6369 __WDP_LOG_FUNC_EXIT__;
6374 /* for now, supplicant dbus interface only provides upnp service fully */
6375 int ws_start_service_discovery(unsigned char *mac_addr, int service_type)
6377 __WDP_LOG_FUNC_ENTER__;
6378 GDBusConnection *g_dbus = NULL;
6379 GVariantBuilder *builder = NULL;
6380 GVariant *value = NULL;
6381 wfd_oem_service_s data = {0,};
6382 dbus_method_param_s params;
6383 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
6388 WDP_LOGE("Invalid parameter");
6389 __WDP_LOG_FUNC_EXIT__;
6394 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
6395 __WDP_LOG_FUNC_EXIT__;
6399 g_dbus = g_pd->g_dbus;
6401 WDP_LOGE("DBus connection is NULL");
6402 __WDP_LOG_FUNC_EXIT__;
6405 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
6407 dbus_set_method_param(¶ms, "ServiceDiscoveryRequest", g_pd->iface_path, g_dbus);
6409 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
6411 if (mac_addr && !ISZEROMACADDR(mac_addr)) {
6412 g_snprintf(peer_path, DBUS_OBJECT_PATH_MAX, "%s/Peers/"
6413 COMPACT_MACSTR, g_pd->iface_path, MAC2STR(mac_addr));
6414 WDP_LOGD("get peer path [%s]", peer_path);
6415 g_variant_builder_add(builder, "{sv}", "peer", g_variant_new_object_path(peer_path));
6418 if (service_type == WFD_OEM_SERVICE_TYPE_ALL) {
6420 char *service_all = "\x02\x00\x00\x01";
6421 GVariantBuilder *query = NULL;
6423 query = g_variant_builder_new(G_VARIANT_TYPE("ay"));
6424 for (i = 0; i < SERVICE_QUERY_LEN; i++)
6425 g_variant_builder_add(query, "y", service_all[i]);
6426 g_variant_builder_add(builder, "{sv}", "query", g_variant_new("ay", query));
6427 g_variant_builder_unref(query);
6428 g_strlcpy(data.service_type, SERV_DISC_REQ_ALL, OEM_SERVICE_TYPE_LEN + 1);
6430 } else if (service_type == WFD_OEM_SERVICE_TYPE_UPNP) {
6432 g_variant_builder_add(builder, "{sv}", "service_type", g_variant_new_string("upnp"));
6433 g_variant_builder_add(builder, "{sv}", "version", g_variant_new_int32(10));
6434 g_variant_builder_add(builder, "{sv}", "service", g_variant_new_string("ssdp:all"));
6435 g_strlcpy(data.service_type, SERV_DISC_REQ_UPNP, OEM_SERVICE_TYPE_LEN + 1);
6437 } else if (service_type == WFD_OEM_SERVICE_TYPE_BONJOUR) {
6439 char *service_bonjour = "\x02\x00\x01\x01";
6440 GVariantBuilder *query = NULL;
6442 query = g_variant_builder_new(G_VARIANT_TYPE("ay"));
6443 for (i = 0; i < SERVICE_QUERY_LEN; i++)
6444 g_variant_builder_add(query, "y", service_bonjour[i]);
6445 g_variant_builder_add(builder, "{sv}", "tlv", g_variant_new("ay", query));
6446 g_variant_builder_unref(query);
6447 g_strlcpy(data.service_type, SERV_DISC_REQ_BONJOUR, OEM_SERVICE_TYPE_LEN + 1);
6450 value = g_variant_new("(a{sv})", builder);
6451 g_variant_builder_unref(builder);
6453 params.params = value;
6454 DEBUG_G_VARIANT("Params : ", params.params);
6456 if (ISZEROMACADDR(mac_addr))
6457 snprintf(data.dev_addr, WS_MACSTR_LEN , "%s", SERV_BROADCAST_ADDRESS);
6459 snprintf(data.dev_addr, WS_MACSTR_LEN, MACSTR, MAC2STR(mac_addr));
6461 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, __add_service_query, &data);
6463 WDP_LOGE("Failed to send command to wpa_supplicant");
6465 WDP_LOGD("Succeeded to start service discovery");
6467 __WDP_LOG_FUNC_EXIT__;
6471 int ws_cancel_service_discovery(unsigned char *mac_addr, int service_type)
6473 __WDP_LOG_FUNC_ENTER__;
6474 GDBusConnection *g_dbus = NULL;
6475 dbus_method_param_s params;
6476 wfd_oem_service_s *data = NULL;
6477 char query_id[OEM_QUERY_ID_LEN + 1] = {0, };
6478 char s_type[OEM_SERVICE_TYPE_LEN + 1] = {0, };
6479 char mac_str[18] = {0, };
6480 long long unsigned id;
6485 WDP_LOGE("Invalid parameter");
6486 __WDP_LOG_FUNC_EXIT__;
6491 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
6492 __WDP_LOG_FUNC_EXIT__;
6496 g_dbus = g_pd->g_dbus;
6498 WDP_LOGE("DBus connection is NULL");
6499 __WDP_LOG_FUNC_EXIT__;
6503 if (ISZEROMACADDR(mac_addr)) {
6504 snprintf(mac_str, WS_MACSTR_LEN , "%s", SERV_BROADCAST_ADDRESS);
6506 snprintf(mac_str, WS_MACSTR_LEN, MACSTR, MAC2STR(mac_addr));
6509 switch (service_type) {
6510 case WFD_OEM_SERVICE_TYPE_ALL:
6511 g_strlcpy(s_type, SERV_DISC_REQ_ALL, OEM_SERVICE_TYPE_LEN + 1);
6513 case WFD_OEM_SERVICE_TYPE_BONJOUR:
6514 g_strlcpy(s_type, SERV_DISC_REQ_BONJOUR, OEM_SERVICE_TYPE_LEN + 1);
6516 case WFD_OEM_SERVICE_TYPE_UPNP:
6517 g_strlcpy(s_type, SERV_DISC_REQ_UPNP, OEM_SERVICE_TYPE_LEN + 1);
6520 WDP_LOGE("Invalid Service type");
6521 __WDP_LOG_FUNC_EXIT__;
6525 WDP_LOGD("Cancel service discovery service_type [%d]", service_type);
6526 WDP_LOGD("Cancel service discovery s_type [%s]", s_type);
6528 data = _remove_service_query(s_type, mac_str, query_id);
6530 __WDP_LOG_FUNC_EXIT__;
6533 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
6535 dbus_set_method_param(¶ms, "ServiceDiscoveryCancelRequest", g_pd->iface_path, g_dbus);
6536 id = (long long unsigned)strtoul(query_id, NULL, 16);
6537 params.params = g_variant_new("(t)", id);
6539 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
6541 WDP_LOGE("Failed to send command to wpa_supplicant");
6543 WDP_LOGD("Succeeded to cancel service discovery");
6545 service_list = g_list_remove(service_list, data);
6548 __WDP_LOG_FUNC_EXIT__;
6552 int ws_serv_add(wfd_oem_new_service_s *service)
6554 __WDP_LOG_FUNC_ENTER__;
6555 GDBusConnection *g_dbus = NULL;
6556 GVariantBuilder *builder = NULL;
6557 GVariant *value = NULL;
6558 dbus_method_param_s params;
6562 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
6563 __WDP_LOG_FUNC_EXIT__;
6567 g_dbus = g_pd->g_dbus;
6569 WDP_LOGE("DBus connection is NULL");
6570 __WDP_LOG_FUNC_EXIT__;
6573 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
6575 dbus_set_method_param(¶ms, "AddService", g_pd->iface_path, g_dbus);
6577 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
6579 if (service->protocol == WFD_OEM_SERVICE_TYPE_BONJOUR) {
6581 WDP_LOGD("Service type: WFD_OEM_SERVICE_TYPE_BONJOUR");
6582 WDP_LOGD("Query: %s", service->data.bonjour.query);
6583 WDP_LOGD("RData: %s", service->data.bonjour.rdata);
6585 res = _convert_bonjour_to_args(service->data.bonjour.query,
6586 service->data.bonjour.rdata, builder);
6588 WDP_LOGE("Failed to convert Key string");
6589 g_variant_builder_unref(builder);
6593 } else if (service->protocol == WFD_OEM_SERVICE_TYPE_UPNP) {
6594 g_variant_builder_add(builder, "{sv}", "service_type", g_variant_new_string("upnp"));
6595 g_variant_builder_add(builder, "{sv}", "version", g_variant_new_int32(10));
6596 g_variant_builder_add(builder, "{sv}", "service", g_variant_new_string(service->data.upnp.service));
6599 value = g_variant_new("(a{sv})", builder);
6600 g_variant_builder_unref(builder);
6602 params.params = value;
6603 DEBUG_G_VARIANT("Params : ", params.params);
6605 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
6607 WDP_LOGE("Failed to send command to wpa_supplicant");
6609 WDP_LOGD("Succeeded to add service");
6611 __WDP_LOG_FUNC_EXIT__;
6615 int ws_serv_del(wfd_oem_new_service_s *service)
6617 __WDP_LOG_FUNC_ENTER__;
6618 GDBusConnection *g_dbus = NULL;
6619 GVariantBuilder *builder = NULL;
6620 GVariant *value = NULL;
6621 dbus_method_param_s params;
6625 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
6626 __WDP_LOG_FUNC_EXIT__;
6630 g_dbus = g_pd->g_dbus;
6632 WDP_LOGE("DBus connection is NULL");
6633 __WDP_LOG_FUNC_EXIT__;
6636 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
6638 dbus_set_method_param(¶ms, "DeleteService", g_pd->iface_path, g_dbus);
6640 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
6642 if (service->protocol == WFD_OEM_SERVICE_TYPE_BONJOUR) {
6644 WDP_LOGD("Service type: WFD_OEM_SERVICE_TYPE_BONJOUR");
6645 WDP_LOGD("Query: %s", service->data.bonjour.query);
6647 res = _convert_bonjour_to_args(service->data.bonjour.query,
6650 WDP_LOGE("Failed to convert Key string");
6651 g_variant_builder_unref(builder);
6655 } else if (service->protocol == WFD_OEM_SERVICE_TYPE_UPNP) {
6656 g_variant_builder_add(builder, "{sv}", "service_type", g_variant_new_string("upnp"));
6657 g_variant_builder_add(builder, "{sv}", "version", g_variant_new_int32(10));
6658 g_variant_builder_add(builder, "{sv}", "service", g_variant_new_string(service->data.upnp.service));
6661 value = g_variant_new("(a{sv})", builder);
6662 g_variant_builder_unref(builder);
6664 params.params = value;
6665 DEBUG_G_VARIANT("Params : ", params.params);
6667 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
6669 WDP_LOGE("Failed to send command to wpa_supplicant");
6671 WDP_LOGD("Succeeded to del service");
6673 __WDP_LOG_FUNC_EXIT__;
6677 int _ws_disable_display()
6679 __WDP_LOG_FUNC_ENTER__;
6680 GDBusConnection *g_dbus = NULL;
6681 GVariantBuilder *builder = NULL;
6682 GVariant *value = NULL;
6683 GVariant *param = NULL;
6684 dbus_method_param_s params;
6688 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
6689 __WDP_LOG_FUNC_EXIT__;
6693 g_dbus = g_pd->g_dbus;
6695 WDP_LOGE("DBus connection is NULL");
6696 __WDP_LOG_FUNC_EXIT__;
6699 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
6701 dbus_set_method_param(¶ms, DBUS_PROPERTIES_METHOD_SET, SUPPLICANT_PATH,
6704 builder = g_variant_builder_new(G_VARIANT_TYPE("ay"));
6705 value = g_variant_new("ay", builder);
6706 g_variant_builder_unref(builder);
6708 param = g_variant_new("(ssv)", SUPPLICANT_INTERFACE, "WFDIEs", value);
6710 params.params = param;
6711 DEBUG_G_VARIANT("Params : ", params.params);
6713 res = dbus_method_call(¶ms, DBUS_PROPERTIES_INTERFACE, NULL, NULL);
6715 WDP_LOGE("Failed to send command to wpa_supplicant");
6717 WDP_LOGD("Succeeded to disable Wi-Fi display");
6719 __WDP_LOG_FUNC_EXIT__;
6723 int ws_miracast_init(int enable)
6725 __WDP_LOG_FUNC_ENTER__;
6726 wfd_oem_display_s wifi_display;
6729 memset(&wifi_display, 0x0, sizeof(wfd_oem_display_s));
6731 wifi_display.availability = enable;
6732 wifi_display.hdcp_support = 1;
6733 wifi_display.port = 0x07E6;
6734 wifi_display.max_tput = 0x0028;
6736 res = ws_set_display(&wifi_display);
6738 WDP_LOGE("Failed to set miracast parameter(device info)");
6739 __WDP_LOG_FUNC_EXIT__;
6744 res = _ws_disable_display();
6746 WDP_LOGE("Failed to disable wifi display");
6748 WDP_LOGD("Succeeded to disable wifi display");
6750 __WDP_LOG_FUNC_EXIT__;
6754 int ws_set_display(wfd_oem_display_s *wifi_display)
6756 __WDP_LOG_FUNC_ENTER__;
6757 GDBusConnection *g_dbus = NULL;
6759 GVariant *value = NULL;
6760 GVariant *param = NULL;
6761 GVariantBuilder *builder = NULL;
6762 dbus_method_param_s params;
6766 unsigned char ies[WFD_SUBELEM_LEN_DEV_INFO + 3] = {0,};
6768 if (!wifi_display) {
6769 WDP_LOGE("Invalid parameter");
6772 g_dbus = g_pd->g_dbus;
6774 WDP_LOGE("DBus connection is NULL");
6775 __WDP_LOG_FUNC_EXIT__;
6778 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
6780 dbus_set_method_param(¶ms, DBUS_PROPERTIES_METHOD_SET, SUPPLICANT_PATH,
6783 ies[2] = WFD_SUBELEM_LEN_DEV_INFO;
6784 ies[3] = wifi_display->hdcp_support;
6785 ies[4] = (wifi_display->type) | (wifi_display->availability<<4);
6786 ies[5] = wifi_display->port>>8;
6787 ies[6] = wifi_display->port&0xff;
6788 ies[7] = wifi_display->max_tput>>8;
6789 ies[8] = wifi_display->max_tput&0xff;
6791 builder = g_variant_builder_new(G_VARIANT_TYPE("ay"));
6792 for (i = 0; i < WFD_SUBELEM_LEN_DEV_INFO + 3; i++)
6793 g_variant_builder_add(builder, "y", ies[i]);
6794 value = g_variant_new("ay", builder);
6795 g_variant_builder_unref(builder);
6797 param = g_variant_new("(ssv)", SUPPLICANT_INTERFACE, "WFDIEs", value);
6799 params.params = param;
6800 DEBUG_G_VARIANT("Params : ", params.params);
6802 res = dbus_method_call(¶ms, DBUS_PROPERTIES_INTERFACE, NULL, NULL);
6804 WDP_LOGE("Failed to send command to wpa_supplicant");
6806 WDP_LOGD("Succeeded to set Wi-Fi Display");
6808 __WDP_LOG_FUNC_EXIT__;
6812 int ws_refresh(void)
6814 __WDP_LOG_FUNC_ENTER__;
6819 __WDP_LOG_FUNC_EXIT__;
6823 int ws_save_config(void)
6825 __WDP_LOG_FUNC_ENTER__;
6826 GDBusConnection *g_dbus = NULL;
6827 dbus_method_param_s params;
6830 g_dbus = g_pd->g_dbus;
6832 WDP_LOGE("DBus connection is NULL");
6833 __WDP_LOG_FUNC_EXIT__;
6836 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
6838 dbus_set_method_param(¶ms, "SaveConfig", g_pd->iface_path, g_dbus);
6839 params.params = NULL;
6841 res = dbus_method_call(¶ms, SUPPLICANT_IFACE, NULL, NULL);
6843 WDP_LOGE("Failed to save config to wpa_supplicant");
6845 WDP_LOGD("Succeeded to save config");
6847 __WDP_LOG_FUNC_EXIT__;
6851 int ws_set_operating_channel(int channel)
6853 __WDP_LOG_FUNC_ENTER__;
6854 GDBusConnection *g_dbus = NULL;
6855 GVariant *value = NULL;
6856 GVariant *param = NULL;
6857 GVariantBuilder *builder = NULL;
6858 dbus_method_param_s params;
6861 g_dbus = g_pd->g_dbus;
6863 WDP_LOGE("DBus connection is NULL");
6864 __WDP_LOG_FUNC_EXIT__;
6868 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
6870 dbus_set_method_param(¶ms, DBUS_PROPERTIES_METHOD_SET, g_pd->iface_path, g_dbus);
6872 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
6873 g_variant_builder_add(builder, "{sv}", "OperChannel", g_variant_new_uint32(channel));
6874 value = g_variant_new("a{sv}", builder);
6875 g_variant_builder_unref(builder);
6877 param = g_variant_new("(ssv)", SUPPLICANT_P2PDEVICE, "P2PDeviceConfig", value);
6878 params.params = param;
6880 res = dbus_method_call(¶ms, DBUS_PROPERTIES_INTERFACE, NULL, NULL);
6882 WDP_LOGE("Failed to send command to wpa_supplicant");
6884 WDP_LOGD("Succeeded to set Operating Channel");
6886 __WDP_LOG_FUNC_EXIT__;
6890 int ws_remove_all_network(void)
6892 __WDP_LOG_FUNC_ENTER__;
6893 GDBusConnection *g_dbus = NULL;
6894 dbus_method_param_s params;
6897 g_dbus = g_pd->g_dbus;
6899 WDP_LOGE("DBus connection is NULL");
6900 __WDP_LOG_FUNC_EXIT__;
6903 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
6905 dbus_set_method_param(¶ms, "RemoveAllNetworks", g_pd->iface_path, g_dbus);
6906 params.params = NULL;
6908 res = dbus_method_call(¶ms, SUPPLICANT_IFACE, NULL, NULL);
6910 WDP_LOGE("Failed to send [RemoveAllNetworks] command to wpa_supplicant");
6912 WDP_LOGD("Succeeded to remove all networks from supplicant");
6914 WDP_LOGD("Succeeded to remove all network");
6915 __WDP_LOG_FUNC_EXIT__;
6919 int ws_get_wpa_status(int *wpa_status)
6921 __WDP_LOG_FUNC_ENTER__;
6922 GDBusConnection *g_dbus = NULL;
6923 GVariant *param = NULL;
6924 GVariant *reply = NULL;
6925 GError *error = NULL;
6928 WDP_LOGE("Invalid parameter");
6929 __WDP_LOG_FUNC_EXIT__;
6933 *wpa_status = WFD_OEM_WPA_STATE_MAX;
6935 g_dbus = g_pd->g_dbus;
6937 WDP_LOGE("DBus connection is NULL");
6938 __WDP_LOG_FUNC_EXIT__;
6942 param = g_variant_new("(s)", SUPPLICANT_IFACE);
6944 reply = g_dbus_connection_call_sync(
6946 SUPPLICANT_SERVICE, /* bus name */
6947 g_pd->iface_path, /* object path */
6948 DBUS_PROPERTIES_INTERFACE, /* interface name */
6949 DBUS_PROPERTIES_METHOD_GETALL, /* method name */
6950 param, /* GVariant *params */
6951 NULL, /* reply_type */
6952 G_DBUS_CALL_FLAGS_NONE, /* flags */
6953 SUPPLICANT_TIMEOUT , /* timeout */
6954 NULL, /* cancellable */
6955 &error); /* error */
6957 if (error != NULL) {
6958 WDP_LOGE("Error! Failed to get properties: [%s]",
6960 g_error_free(error);
6962 g_variant_unref(reply);
6963 __WDP_LOG_FUNC_EXIT__;
6967 gchar *reply_str = NULL;
6969 reply_str = g_variant_print(reply, TRUE);
6970 WDP_LOGE("reply [%s]", reply_str ? reply_str : "NULL");
6973 if (reply != NULL) {
6974 GVariantIter *iter = NULL;
6975 g_variant_get(reply, "(a{sv})", &iter);
6979 GVariant *value = NULL;
6981 while (g_variant_iter_loop(iter, "{sv}", &key, &value)) {
6982 if (g_strcmp0(key, "State") == 0) {
6983 const gchar *state = NULL;
6984 g_variant_get(value, "&s", &state);
6985 WDP_LOGI("state : [%s]", state);
6987 if (g_strcmp0(state, "disconnected") == 0)
6988 *wpa_status = WFD_OEM_WPA_STATE_DISCONNECTED;
6989 else if (g_strcmp0(state, "inactive") == 0)
6990 *wpa_status = WFD_OEM_WPA_STATE_INACTIVE;
6991 else if (g_strcmp0(state, "scanning") == 0)
6992 *wpa_status = WFD_OEM_WPA_STATE_SCANNING;
6993 else if (g_strcmp0(state, "authenticating") == 0)
6994 *wpa_status = WFD_OEM_WPA_STATE_AUTHENTICATING;
6995 else if (g_strcmp0(state, "associating") == 0)
6996 *wpa_status = WFD_OEM_WPA_STATE_ASSOCIATING;
6997 else if (g_strcmp0(state, "associated") == 0)
6998 *wpa_status = WFD_OEM_WPA_STATE_ASSOCIATED;
6999 else if (g_strcmp0(state, "4way_handshake") == 0)
7000 *wpa_status = WFD_OEM_WPA_STATE_4WAY_HANDSHAKE;
7001 else if (g_strcmp0(state, "group_handshake") == 0)
7002 *wpa_status = WFD_OEM_WPA_STATE_GROUP_HANDSHAKE;
7003 else if (g_strcmp0(state, "completed") == 0)
7004 *wpa_status = WFD_OEM_WPA_STATE_COMPLETED;
7006 *wpa_status = WFD_OEM_WPA_STATE_MAX;
7009 g_variant_iter_free(iter);
7011 g_variant_unref(reply);
7013 WDP_LOGD("No properties");
7016 WDP_LOGI("wpa_status : [%d]", *wpa_status);
7018 __WDP_LOG_FUNC_EXIT__;
7022 int ws_advertise_service(wfd_oem_asp_service_s *service, int replace)
7024 __WDP_LOG_FUNC_ENTER__;
7025 GDBusConnection *g_dbus = NULL;
7026 GVariantBuilder *builder = NULL;
7027 GVariant *value = NULL;
7028 dbus_method_param_s params;
7029 unsigned int config_method = 0x1108;
7030 int auto_accept = 0;
7034 g_dbus = g_pd->g_dbus;
7036 WDP_LOGE("DBus connection is NULL");
7040 if (service->config_method == 2) {
7041 config_method = WS_CONFIG_METHOD_KEYPAD |
7042 WS_CONFIG_METHOD_DISPLAY;
7043 } else if (service->config_method == 3) {
7044 config_method = WS_CONFIG_METHOD_DISPLAY;
7045 } else if (service->config_method == 4) {
7046 config_method = WS_CONFIG_METHOD_KEYPAD;
7049 if (service->auto_accept) {
7050 if (service->role == 0)
7058 rep = (replace == 1);
7060 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
7062 dbus_set_method_param(¶ms, "AddService", g_pd->iface_path, g_dbus);
7064 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
7066 g_variant_builder_add(builder, "{sv}", "service_type", g_variant_new_string("asp"));
7067 g_variant_builder_add(builder, "{sv}", "auto_accept", g_variant_new_int32(auto_accept));
7068 g_variant_builder_add(builder, "{sv}", "adv_id", g_variant_new_uint32(service->adv_id));
7069 g_variant_builder_add(builder, "{sv}", "svc_state", g_variant_new_uint32(service->status));
7070 g_variant_builder_add(builder, "{sv}", "config_method", g_variant_new_uint32(config_method));
7071 g_variant_builder_add(builder, "{sv}", "replace", g_variant_new_boolean(rep));
7072 if (service->service_type != NULL)
7073 g_variant_builder_add(builder, "{sv}", "adv_str",
7074 g_variant_new_string(service->service_type));
7075 if (service->service_info != NULL)
7076 g_variant_builder_add(builder, "{sv}", "svc_info",
7077 g_variant_new_string(service->service_info));
7078 if (service->instance_name != NULL)
7079 g_variant_builder_add(builder, "{sv}", "svc_instance",
7080 g_variant_new_string(service->instance_name));
7082 value = g_variant_new("(a{sv})", builder);
7083 g_variant_builder_unref(builder);
7084 DEBUG_G_VARIANT("Params : ", value);
7086 params.params = value;
7088 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
7090 WDP_LOGE("Failed to send command to wpa_supplicant");
7092 WDP_LOGD("Succeeded to add service");
7094 __WDP_LOG_FUNC_EXIT__;
7098 int ws_cancel_advertise_service(wfd_oem_asp_service_s *service)
7100 __WDP_LOG_FUNC_ENTER__;
7101 GDBusConnection *g_dbus = NULL;
7102 GVariantBuilder *builder = NULL;
7103 GVariant *value = NULL;
7104 dbus_method_param_s params;
7107 g_dbus = g_pd->g_dbus;
7109 WDP_LOGE("DBus connection is NULL");
7112 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
7114 dbus_set_method_param(¶ms, "DeleteService", g_pd->iface_path, g_dbus);
7116 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
7118 g_variant_builder_add(builder, "{sv}", "service_type", g_variant_new_string("asp"));
7119 g_variant_builder_add(builder, "{sv}", "adv_id", g_variant_new_uint32(service->adv_id));
7121 value = g_variant_new("(a{sv})", builder);
7122 g_variant_builder_unref(builder);
7123 DEBUG_G_VARIANT("Params : ", value);
7124 params.params = value;
7126 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
7128 WDP_LOGE("Failed to send command to wpa_supplicant");
7130 WDP_LOGD("Succeeded to del service");
7132 __WDP_LOG_FUNC_EXIT__;
7136 static void __ws_add_seek(wfd_oem_asp_service_s *service)
7138 __WDP_LOG_FUNC_ENTER__;
7139 wfd_oem_asp_service_s *seek = NULL;
7141 WDP_LOGE("invalid parameters");
7145 seek = g_try_malloc0(sizeof(wfd_oem_asp_service_s));
7147 WDP_LOGE("Failed to allocate memory for service");
7151 service->search_id = (intptr_t)seek;
7152 memcpy(seek, service, sizeof(wfd_oem_asp_service_s));
7153 if (service->service_type)
7154 seek->service_type = strdup(service->service_type);
7155 seek_list = g_list_prepend(seek_list, seek);
7157 __WDP_LOG_FUNC_EXIT__;
7161 static wfd_oem_asp_service_s * __ws_get_seek(long long unsigned asp_search_id)
7163 __WDP_LOG_FUNC_ENTER__;
7164 wfd_oem_asp_service_s *seek = NULL;
7167 for (list = seek_list; list != NULL; list = list->next) {
7169 if (seek && (seek->asp_search_id == asp_search_id)) {
7170 WDP_LOGD("List found");
7176 __WDP_LOG_FUNC_EXIT__;
7180 static void __ws_remove_seek(wfd_oem_asp_service_s *service)
7182 __WDP_LOG_FUNC_ENTER__;
7183 wfd_oem_asp_service_s *seek = NULL;
7186 for (list = seek_list; list != NULL; list = list->next) {
7189 if (seek && (seek->asp_search_id == service->asp_search_id)) {
7190 WDP_LOGD("List remove");
7191 seek_list = g_list_remove(seek_list, seek);
7192 g_free(seek->service_type);
7193 g_free(seek->service_info);
7197 __WDP_LOG_FUNC_EXIT__;
7201 static void __get_asp_search_id(GVariant *value, void *args)
7203 __WDP_LOG_FUNC_ENTER__;
7204 wfd_oem_asp_service_s *service = NULL;
7205 wfd_oem_asp_service_s *seek = NULL;
7206 long long unsigned search_id = 0;
7208 g_variant_get(value, "(t)", &search_id);
7210 service = (wfd_oem_asp_service_s *)args;
7212 WDP_LOGE("invalid parameters");
7213 __WDP_LOG_FUNC_EXIT__;
7217 seek = g_try_malloc0(sizeof(wfd_oem_asp_service_s));
7219 WDP_LOGE("Failed to allocate memory for service");
7220 __WDP_LOG_FUNC_EXIT__;
7224 service->search_id = search_id;
7225 memcpy(seek, service, sizeof(wfd_oem_asp_service_s));
7226 if (service->service_type)
7227 seek->service_type = strdup(service->service_type);
7228 if (service->service_info)
7229 seek->service_info = strdup(service->service_info);
7230 seek_list = g_list_append(seek_list, seek);
7232 __WDP_LOG_FUNC_EXIT__;
7236 int ws_seek_service(wfd_oem_asp_service_s *service)
7238 __WDP_LOG_FUNC_ENTER__;
7239 GDBusConnection *g_dbus = NULL;
7241 wfd_oem_asp_service_s *seek = NULL;
7244 g_dbus = g_pd->g_dbus;
7246 WDP_LOGE("DBus connection is NULL");
7247 __WDP_LOG_FUNC_EXIT__;
7250 list = g_list_last(seek_list);
7252 service->tran_id = 1;
7257 service->tran_id = seek->tran_id + 1;
7259 service->tran_id = 1;
7262 if (service->service_info) {
7263 GVariantBuilder *builder = NULL;
7264 GVariant *value = NULL;
7265 dbus_method_param_s params;
7267 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
7268 dbus_set_method_param(¶ms, "ServiceDiscoveryRequest",
7269 g_pd->iface_path, g_dbus);
7271 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
7273 g_variant_builder_add(builder, "{sv}", "service_type",
7274 g_variant_new_string("asp"));
7275 g_variant_builder_add(builder, "{sv}", "transaction_id",
7276 g_variant_new_byte(service->tran_id));
7277 if (service->service_type != NULL)
7278 g_variant_builder_add(builder, "{sv}", "svc_str",
7279 g_variant_new_string(service->service_type));
7281 if (service->service_info != NULL)
7282 g_variant_builder_add(builder, "{sv}", "svc_info",
7283 g_variant_new_string(service->service_info));
7285 if (service->instance_name != NULL)
7286 g_variant_builder_add(builder, "{sv}", "svc_instance",
7287 g_variant_new_string(service->instance_name));
7289 value = g_variant_new("(a{sv})", builder);
7290 g_variant_builder_unref(builder);
7292 DEBUG_G_VARIANT("Params : ", value);
7294 params.params = value;
7295 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE,
7296 __get_asp_search_id, service);
7299 __ws_add_seek(service);
7303 WDP_LOGE("Failed to send command to wpa_supplicant");
7305 WDP_LOGD("Succeeded to seek service");
7307 __WDP_LOG_FUNC_EXIT__;
7311 int ws_cancel_seek_service(wfd_oem_asp_service_s *service)
7313 __WDP_LOG_FUNC_ENTER__;
7314 GDBusConnection *g_dbus = NULL;
7315 wfd_oem_asp_service_s *seek = NULL;
7316 dbus_method_param_s params;
7319 g_dbus = g_pd->g_dbus;
7321 WDP_LOGE("DBus connection is NULL");
7322 __WDP_LOG_FUNC_EXIT__;
7326 seek = __ws_get_seek(service->asp_search_id);
7328 WDP_LOGE("seek data is NULL");
7329 __WDP_LOG_FUNC_EXIT__;
7333 if (seek->service_info) {
7335 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
7336 dbus_set_method_param(¶ms, "ServiceDiscoveryCancelRequest",
7337 g_pd->iface_path, g_dbus);
7339 params.params = g_variant_new("(t)", service->search_id);
7341 DEBUG_G_VARIANT("Params : ", params.params);
7343 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
7345 WDP_LOGE("Failed to send command to wpa_supplicant");
7347 WDP_LOGD("Succeeded to cancel seek service");
7350 __ws_remove_seek(seek);
7352 __WDP_LOG_FUNC_EXIT__;
7356 int ws_asp_prov_disc_req(wfd_oem_asp_prov_s *asp_params)
7358 __WDP_LOG_FUNC_ENTER__;
7359 GDBusConnection *g_dbus = NULL;
7360 GVariantBuilder *builder = NULL;
7361 GVariantBuilder *mac_builder = NULL;
7362 GVariant *value = NULL;
7363 dbus_method_param_s params;
7364 static char peer_path[DBUS_OBJECT_PATH_MAX] = {'\0',};
7365 int config_method = 0x1000;
7370 WDP_LOGE("Invalid parameter");
7371 __WDP_LOG_FUNC_EXIT__;
7374 g_dbus = g_pd->g_dbus;
7376 WDP_LOGE("DBus connection is NULL");
7377 __WDP_LOG_FUNC_EXIT__;
7381 if (asp_params->network_config == WFD_OEM_ASP_WPS_TYPE_PIN_DISPLAY)
7382 config_method = 0x8;
7383 else if (asp_params->network_config == WFD_OEM_ASP_WPS_TYPE_PIN_KEYPAD)
7384 config_method = 0x100;
7386 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
7388 dbus_set_method_param(¶ms, "ASPProvisionDiscoveryRequest", g_pd->iface_path, g_dbus);
7390 if (asp_params->deferring == 0)
7391 g_snprintf(peer_path, DBUS_OBJECT_PATH_MAX, "%s/Peers/"
7392 COMPACT_MACSTR, g_pd->iface_path, MAC2STR(asp_params->service_mac));
7394 g_snprintf(peer_path, DBUS_OBJECT_PATH_MAX, "%s/Peers/"
7395 COMPACT_MACSTR, g_pd->iface_path, MAC2STR(asp_params->session_mac));
7396 WDP_LOGD("get peer path [%s]", peer_path);
7398 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
7399 g_variant_builder_add(builder, "{sv}", "peer", g_variant_new_object_path(peer_path));
7401 g_variant_builder_add(builder, "{sv}", "adv_id", g_variant_new_uint32(asp_params->adv_id));
7402 g_variant_builder_add(builder, "{sv}", "session_id", g_variant_new_uint32(asp_params->session_id));
7403 g_variant_builder_add(builder, "{sv}", "role", g_variant_new_byte(asp_params->network_role));
7404 g_variant_builder_add(builder, "{sv}", "method", g_variant_new_int32(config_method));
7405 if (asp_params->status > 0)
7406 g_variant_builder_add(builder, "{sv}", "status", g_variant_new_int32(asp_params->status));
7407 if (asp_params->session_information)
7408 g_variant_builder_add(builder, "{sv}", "info", g_variant_new_string(asp_params->session_information));
7410 mac_builder = g_variant_builder_new(G_VARIANT_TYPE("ay"));
7411 for (i = 0; i < OEM_MACADDR_LEN; i++)
7412 g_variant_builder_add(mac_builder, "y", asp_params->service_mac[i]);
7413 g_variant_builder_add(builder, "{sv}", "adv_mac",
7414 g_variant_new("ay", mac_builder));
7415 g_variant_builder_unref(mac_builder);
7417 mac_builder = g_variant_builder_new(G_VARIANT_TYPE("ay"));
7418 for (i = 0; i < OEM_MACADDR_LEN; i++)
7419 g_variant_builder_add(mac_builder, "y", asp_params->session_mac[i]);
7420 g_variant_builder_add(builder, "{sv}", "session_mac",
7421 g_variant_new("ay", mac_builder));
7422 g_variant_builder_unref(mac_builder);
7424 value = g_variant_new("(a{sv})", builder);
7425 g_variant_builder_unref(builder);
7426 DEBUG_G_VARIANT("Params : ", value);
7428 params.params = value;
7430 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
7432 WDP_LOGE("Failed to send command to wpa_supplicant");
7434 WDP_LOGD("Succeeded to send connection command to peer[" MACSTR "]", MAC2STR(asp_params->service_mac));
7436 __WDP_LOG_FUNC_EXIT__;
7440 int ws_set_eapol_ip_config(int enable)
7442 __WDP_LOG_FUNC_ENTER__;
7443 GDBusConnection *g_dbus = NULL;
7445 GVariant *value = NULL;
7446 GVariant *param = NULL;
7447 GVariantBuilder *builder = NULL;
7448 GVariantBuilder *type_builder = NULL;
7449 dbus_method_param_s params;
7458 unsigned char eapol_ip[IP_END + 1][OEM_IPADDR_LEN + 1] = {0,};
7461 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
7462 __WDP_LOG_FUNC_EXIT__;
7466 g_dbus = g_pd->g_dbus;
7468 WDP_LOGE("DBus connection is NULL");
7469 __WDP_LOG_FUNC_EXIT__;
7472 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
7474 dbus_set_method_param(¶ms, DBUS_PROPERTIES_METHOD_SET, g_pd->iface_path,
7477 builder = g_variant_builder_new(G_VARIANT_TYPE("a{sv}"));
7479 memset(&eapol_ip, 0x0, (IP_END + 1) * (OEM_IPADDR_LEN + 1));
7481 memcpy(eapol_ip[IP_GO], DEFAULT_IP_GO, OEM_IPADDR_LEN);
7482 memcpy(eapol_ip[IP_MASK], DEFAULT_IP_MASK, OEM_IPADDR_LEN);
7483 memcpy(eapol_ip[IP_START], DEFAULT_IP_START, OEM_IPADDR_LEN);
7484 memcpy(eapol_ip[IP_END], DEFAULT_IP_END, OEM_IPADDR_LEN);
7487 type_builder = g_variant_builder_new(G_VARIANT_TYPE("ay"));
7488 for (i = 0; i < OEM_IPADDR_LEN; i++)
7489 g_variant_builder_add(type_builder, "y", eapol_ip[IP_GO][i]);
7490 g_variant_builder_add(builder, "{sv}", "IpAddrGo",
7491 g_variant_new("ay", type_builder));
7492 g_variant_builder_unref(type_builder);
7494 type_builder = g_variant_builder_new(G_VARIANT_TYPE("ay"));
7495 for (i = 0; i < OEM_IPADDR_LEN; i++)
7496 g_variant_builder_add(type_builder, "y", eapol_ip[IP_MASK][i]);
7497 g_variant_builder_add(builder, "{sv}", "IpAddrMask",
7498 g_variant_new("ay", type_builder));
7499 g_variant_builder_unref(type_builder);
7501 type_builder = g_variant_builder_new(G_VARIANT_TYPE("ay"));
7502 for (i = 0; i < OEM_IPADDR_LEN; i++)
7503 g_variant_builder_add(type_builder, "y", eapol_ip[IP_START][i]);
7504 g_variant_builder_add(builder, "{sv}", "IpAddrStart",
7505 g_variant_new("ay", type_builder));
7506 g_variant_builder_unref(type_builder);
7508 type_builder = g_variant_builder_new(G_VARIANT_TYPE("ay"));
7509 for (i = 0; i < OEM_IPADDR_LEN; i++)
7510 g_variant_builder_add(type_builder, "y", eapol_ip[IP_END][i]);
7511 g_variant_builder_add(builder, "{sv}", "IpAddrEnd",
7512 g_variant_new("ay", type_builder));
7513 g_variant_builder_unref(type_builder);
7515 value = g_variant_new("a{sv}", builder);
7516 g_variant_builder_unref(builder);
7518 param = g_variant_new("(ssv)", SUPPLICANT_P2PDEVICE, "P2PDeviceConfig", value);
7520 params.params = param;
7522 DEBUG_G_VARIANT("Params : ", param);
7523 res = dbus_method_call(¶ms, DBUS_PROPERTIES_INTERFACE, NULL, NULL);
7525 WDP_LOGE("Failed to send command to wpa_supplicant");
7527 WDP_LOGI("Succeeded to set eapol IP");
7529 __WDP_LOG_FUNC_EXIT__;
7533 int ws_add_vsie(wfd_oem_vsie_frames_e frame_id, const char* vsie)
7535 __WDP_LOG_FUNC_ENTER__;
7536 GDBusConnection *g_dbus = NULL;
7537 GVariant *value = NULL;
7538 GVariantBuilder *bytearray_builder = NULL;
7539 dbus_method_param_s params;
7542 size_t vsie_len = 0;
7544 unsigned char *bytearray = NULL;
7545 size_t bytearray_len = 0;
7547 if (frame_id >= WFD_OEM_VSIE_FRAME_MAX ||
7549 WDP_LOGE("Invalid parameter");
7554 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
7555 __WDP_LOG_FUNC_EXIT__;
7559 g_dbus = g_pd->g_dbus;
7561 WDP_LOGE("DBus connection is NULL");
7562 __WDP_LOG_FUNC_EXIT__;
7566 vsie_len = strlen(vsie);
7567 if (vsie_len == 0) {
7568 WDP_LOGE("vsie length is zero");
7569 __WDP_LOG_FUNC_EXIT__;
7573 bytearray_len = (vsie_len % 2) ? ((vsie_len / 2) + 1) : (vsie_len / 2);
7575 bytearray = (unsigned char *) g_try_malloc0(bytearray_len);
7576 if (bytearray == NULL) {
7577 WDP_LOGE("Failed to allocate memory to bytearray");
7578 __WDP_LOG_FUNC_EXIT__;
7582 if (__ws_hex_str_to_bin(vsie, bytearray, bytearray_len) < 0) {
7583 WDP_LOGE("invalid vsie string");
7585 __WDP_LOG_FUNC_EXIT__;
7589 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
7590 dbus_set_method_param(¶ms, "VendorElemAdd", g_pd->iface_path,
7593 bytearray_builder = g_variant_builder_new(G_VARIANT_TYPE("ay"));
7594 for (i = 0; i < bytearray_len; i++)
7595 g_variant_builder_add(bytearray_builder, "y", bytearray[i]);
7597 value = g_variant_new("(iay)", frame_id, bytearray_builder);
7598 g_variant_builder_unref(bytearray_builder);
7600 params.params = value;
7602 res = dbus_method_call(¶ms, SUPPLICANT_IFACE, NULL, NULL);
7604 WDP_LOGE("Failed to send command to wpa_supplicant");
7606 __WDP_LOG_FUNC_EXIT__;
7610 WDP_LOGD("Succeeded to add vsie: Frame ID [%d], VSIE [%s]", frame_id,
7614 __WDP_LOG_FUNC_EXIT__;
7618 int ws_get_vsie(wfd_oem_vsie_frames_e frame_id, char **vsie)
7620 __WDP_LOG_FUNC_ENTER__;
7621 GDBusConnection *g_dbus = NULL;
7622 GVariant *param = NULL;
7623 GVariant *reply = NULL;
7624 GError *error = NULL;
7626 if (frame_id >= WFD_OEM_VSIE_FRAME_MAX ||
7628 WDP_LOGE("Invalid parameter");
7629 __WDP_LOG_FUNC_EXIT__;
7634 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
7635 __WDP_LOG_FUNC_EXIT__;
7639 g_dbus = g_pd->g_dbus;
7641 WDP_LOGE("DBus connection is NULL");
7642 __WDP_LOG_FUNC_EXIT__;
7646 param = g_variant_new("(i)", frame_id);
7648 reply = g_dbus_connection_call_sync(
7650 SUPPLICANT_SERVICE, /* bus name */
7651 g_pd->iface_path, /* object path */
7652 SUPPLICANT_IFACE, /* interface name */
7653 "VendorElemGet", /* method name */
7654 param, /* GVariant *params */
7655 NULL, /* reply_type */
7656 G_DBUS_CALL_FLAGS_NONE, /* flags */
7657 SUPPLICANT_TIMEOUT, /* timeout */
7658 NULL, /* cancellable */
7659 &error); /* error */
7661 if (error != NULL) {
7662 WDP_LOGE("Error! Failed to get vsie: [%s]", error->message);
7663 g_error_free(error);
7665 g_variant_unref(reply);
7666 __WDP_LOG_FUNC_EXIT__;
7670 if (reply != NULL) {
7671 DEBUG_G_VARIANT("Reply : ", reply);
7673 GVariantIter *iter = NULL;
7674 unsigned char *vsie_bytes = NULL;
7677 g_variant_get(reply, "(ay)", &iter);
7679 WDP_LOGD("vsie is not present");
7680 __WDP_LOG_FUNC_EXIT__;
7684 vsie_len = __ws_unpack_ay_malloc(&vsie_bytes, iter);
7685 if (vsie_bytes == NULL) {
7686 WDP_LOGD("vsie_bytes not allocated");
7687 __WDP_LOG_FUNC_EXIT__;
7691 __ws_byte_to_txt(vsie_bytes, vsie, vsie_len);
7694 WDP_LOGE("vsie not allocated.");
7695 __WDP_LOG_FUNC_EXIT__;
7702 WDP_LOGD("Succeeded to get vsie: Frame ID [%d], VSIE [%s]", frame_id,
7704 __WDP_LOG_FUNC_EXIT__;
7708 int ws_remove_vsie(wfd_oem_vsie_frames_e frame_id, const char *vsie)
7710 __WDP_LOG_FUNC_ENTER__;
7711 GDBusConnection *g_dbus = NULL;
7712 GVariantBuilder *bytearray_builder = NULL;
7713 GVariant *value = NULL;
7714 dbus_method_param_s params;
7717 size_t vsie_len = 0;
7719 unsigned char *bytearray = NULL;
7720 size_t bytearray_len = 0;
7722 if (frame_id >= WFD_OEM_VSIE_FRAME_MAX ||
7724 WDP_LOGE("Invalid parameter");
7729 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
7730 __WDP_LOG_FUNC_EXIT__;
7734 g_dbus = g_pd->g_dbus;
7736 WDP_LOGE("DBus connection is NULL");
7737 __WDP_LOG_FUNC_EXIT__;
7741 vsie_len = strlen(vsie);
7742 if (vsie_len == 0) {
7743 WDP_LOGE("vsie length is zero");
7744 __WDP_LOG_FUNC_EXIT__;
7748 bytearray_len = (vsie_len % 2) ? ((vsie_len / 2) + 1) : (vsie_len / 2);
7750 bytearray = (unsigned char *) g_try_malloc0(bytearray_len);
7751 if (bytearray == NULL) {
7752 WDP_LOGE("Failed to allocate memory to bytearray");
7753 __WDP_LOG_FUNC_EXIT__;
7757 if (__ws_hex_str_to_bin(vsie, bytearray, bytearray_len) < 0) {
7758 WDP_LOGE("invalid vsie string");
7760 __WDP_LOG_FUNC_EXIT__;
7764 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
7765 dbus_set_method_param(¶ms, "VendorElemRem", g_pd->iface_path,
7768 bytearray_builder = g_variant_builder_new(G_VARIANT_TYPE("ay"));
7769 for (i = 0; i < bytearray_len; i++)
7770 g_variant_builder_add(bytearray_builder, "y", bytearray[i]);
7772 value = g_variant_new("(iay)", frame_id, bytearray_builder);
7773 g_variant_builder_unref(bytearray_builder);
7775 params.params = value;
7777 res = dbus_method_call(¶ms, SUPPLICANT_IFACE, NULL, NULL);
7779 WDP_LOGE("Failed to send command to wpa_supplicant");
7781 __WDP_LOG_FUNC_EXIT__;
7785 WDP_LOGD("Succeeded to remove vsie: Frame ID [%d], VSIE [%s]", frame_id,
7788 __WDP_LOG_FUNC_EXIT__;
7792 int ws_set_supported_wps_mode(int wps_mode)
7794 __WDP_LOG_FUNC_ENTER__;
7795 char config_value[DBUS_OBJECT_PATH_MAX+1] = {0,};
7797 int new_wps_mode = wps_mode;
7801 WDP_LOGE("no configurable data found");
7802 __WDP_LOG_FUNC_EXIT__;
7806 if (new_wps_mode == 0) {
7807 WDP_LOGE("Reset to default value");
7808 new_wps_mode = WFD_OEM_WPS_MODE_PBC|WFD_OEM_WPS_MODE_DISPLAY|WFD_OEM_WPS_MODE_KEYPAD;
7811 if (new_wps_mode & WFD_OEM_WPS_MODE_KEYPAD) {
7812 g_strlcat(config_value, "keypad ", sizeof(config_value));
7815 if (new_wps_mode & WFD_OEM_WPS_MODE_PBC) {
7816 g_strlcat(config_value, "virtual_push_button ", sizeof(config_value));
7819 if (new_wps_mode & WFD_OEM_WPS_MODE_DISPLAY) {
7820 g_strlcat(config_value, "physical_display ", sizeof(config_value));
7823 config_value[length-1] = 0;
7824 g_strlcpy(config->config_methods, config_value, OEM_CONFIG_METHOD_LEN);
7825 WDP_LOGD("config_value = %s, length = %d", config_value, length-1);
7826 res = __ws_set_config_methods();
7828 WDP_LOGE("Failed to set config method");
7829 __WDP_LOG_FUNC_EXIT__;
7832 wps_config_method = new_wps_mode;
7833 __WDP_LOG_FUNC_EXIT__;
7837 static int _ws_remove_persistent_group_by_object_path(const char *object_path)
7839 __WDP_LOG_FUNC_ENTER__;
7840 GDBusConnection *g_dbus = NULL;
7841 dbus_method_param_s params;
7845 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
7846 __WDP_LOG_FUNC_EXIT__;
7850 g_dbus = g_pd->g_dbus;
7852 WDP_LOGE("DBus connection is NULL");
7853 __WDP_LOG_FUNC_EXIT__;
7857 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
7858 dbus_set_method_param(¶ms, "RemovePersistentGroup",
7859 g_pd->iface_path, g_dbus);
7860 params.params = g_variant_new("(o)", object_path);
7862 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
7864 WDP_LOGE("Failed to send command to wpa_supplicant");
7865 __WDP_LOG_FUNC_EXIT__;
7870 WDP_LOGD("Succeeded to remove persistent group");;
7871 __WDP_LOG_FUNC_EXIT__;
7875 int ws_remove_persistent_device(unsigned char *mac_addr)
7877 __WDP_LOG_FUNC_ENTER__;
7878 GDBusConnection *g_dbus = NULL;
7879 ws_network_info_s networks[WS_MAX_PERSISTENT_COUNT];
7882 int need_delete = 0;
7886 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
7887 __WDP_LOG_FUNC_EXIT__;
7891 g_dbus = g_pd->g_dbus;
7893 WDP_LOGE("DBus connection is NULL");
7894 __WDP_LOG_FUNC_EXIT__;
7897 memset(&networks, 0x0, WS_MAX_PERSISTENT_COUNT * sizeof(ws_network_info_s));
7898 dbus_property_get_all(g_pd->iface_path, g_dbus, SUPPLICANT_P2PDEVICE,
7899 __ws_extract_p2pdevice_details, networks);
7901 cnt = networks[0].total;
7903 WDP_LOGD("Persistent Group Count=%d", cnt);
7904 if (cnt > WS_MAX_PERSISTENT_COUNT) {
7905 WDP_LOGE("Persistent group count exceeded or parsing error");
7906 __WDP_LOG_FUNC_EXIT__;
7910 for (i = 0 ; i < cnt ; i++) {
7914 WDP_LOGD("----persistent group [%d]----", i);
7915 WDP_LOGD("network_id [%d]", networks[i].network_id);
7916 WDP_LOGD("ssid [%s]", networks[i].ssid);
7917 WDP_LOGD("bssid ["MACSTR"]", MAC2STR(networks[i].bssid));
7918 WDP_LOGD("p2p_client_num [%d]", networks[i].p2p_client_num);
7919 for (j = 0; j < networks[i].p2p_client_num; j++) {
7920 WDP_LOGD("p2p_client_list ["MACSTR"]", MAC2STR(networks[i].p2p_client_list[j]));
7923 WDP_LOGD("mac_addr ["MACSTR"]", MAC2STR(mac_addr));
7925 if (memcmp(mac_addr, networks[i].bssid, WS_MACADDR_LEN) == 0) {
7926 WDP_LOGD("Persistent group owner found [%d: "MACSTR"]", networks[i].network_id, MAC2STR(mac_addr));
7930 if (need_delete == 0) {
7931 for (j = 0; j < networks[i].p2p_client_num; j++) {
7932 if (!memcmp(mac_addr, networks[i].p2p_client_list[j], WS_MACADDR_LEN)) {
7933 WDP_LOGD("Persistent group client found [%d: "MACSTR"]", networks[i].network_id, MAC2STR(mac_addr));
7940 res = _ws_remove_persistent_group_by_object_path(networks[i].persistent_path);
7941 WDP_LOGI("persistent group deleted [%s]", networks[i].persistent_path);
7943 WDP_LOGE("Failed to _ws_remove_persistent_group_by_object_path");
7945 WDP_LOGD("Succeeded to _ws_remove_persistent_group_by_object_path");
7950 __WDP_LOG_FUNC_EXIT__;
7954 int ws_remove_all_persistent_device(void)
7956 __WDP_LOG_FUNC_ENTER__;
7957 GDBusConnection *g_dbus = NULL;
7958 dbus_method_param_s params;
7961 g_dbus = g_pd->g_dbus;
7963 WDP_LOGE("DBus connection is NULL");
7964 __WDP_LOG_FUNC_EXIT__;
7967 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
7969 dbus_set_method_param(¶ms, "RemoveAllPersistentGroups", g_pd->iface_path, g_dbus);
7970 params.params = NULL;
7972 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE, NULL, NULL);
7974 WDP_LOGE("Failed to RemoveAllPersistentGroups");
7976 WDP_LOGD("Succeeded to RemoveAllPersistentGroups");
7980 WDP_LOGD("Succeeded to remove all network");
7981 __WDP_LOG_FUNC_EXIT__;
7985 static void __ws_get_supported_channels_reply(GVariant *reply, void *user_data)
7987 __WDP_LOG_FUNC_ENTER__;
7989 GVariantIter *iter = NULL;
7990 wfd_oem_supported_channels_s *data = (wfd_oem_supported_channels_s *)user_data;
7995 g_variant_get(reply, "(ai)", &iter);
7997 while (g_variant_iter_loop(iter, "i", &channel))
7998 data->channels[data->count++] = channel;
8000 g_variant_iter_free (iter);
8003 WDP_LOGE("Reply is NULL");
8005 __WDP_LOG_FUNC_EXIT__;
8008 int ws_get_supported_channels(wfd_oem_supported_channels_s *data)
8010 __WDP_LOG_FUNC_ENTER__;
8012 dbus_method_param_s params;
8015 WDP_LOGE("ws_dbus_plugin_data_s is not created yet");
8016 __WDP_LOG_FUNC_EXIT__;
8020 memset(¶ms, 0x0, sizeof(dbus_method_param_s));
8021 memset(data, 0x0, sizeof(wfd_oem_supported_channels_s));
8023 dbus_set_method_param(¶ms, "GetSupportedChannels", g_pd->iface_path, g_pd->g_dbus);
8024 params.params = NULL;
8026 res = dbus_method_call(¶ms, SUPPLICANT_P2PDEVICE,
8027 __ws_get_supported_channels_reply, data);
8029 WDP_LOGE("Failed to GetSupportedChannels");
8031 WDP_LOGD("Succeeded to GetSupportedChannels");
8034 __WDP_LOG_FUNC_EXIT__;