1/* 2 * Driver interaction with extended Linux CFG8021 3 * 4 * This program is free software; you can redistribute it and/or modify 5 * it under the terms of the GNU General Public License version 2 as 6 * published by the Free Software Foundation. 7 * 8 * Alternatively, this software may be distributed under the terms of BSD 9 * license. 10 * 11 */ 12 13#include <sys/cdefs.h> 14#include "hardware_legacy/driver_nl80211.h" 15#include "wpa_supplicant_i.h" 16#include "config.h" 17#ifdef ANDROID 18#include "android_drv.h" 19#endif 20 21 22typedef struct android_wifi_priv_cmd { 23#ifdef BCMDHD_64_BIT_IPC 24 u64 bufaddr; 25#else 26 char *bufaddr; 27#endif 28 int used_len; 29 int total_len; 30} android_wifi_priv_cmd; 31 32static int drv_errors = 0; 33 34static void wpa_driver_send_hang_msg(struct wpa_driver_nl80211_data *drv) 35{ 36 drv_errors++; 37 if (drv_errors > DRV_NUMBER_SEQUENTIAL_ERRORS) { 38 drv_errors = 0; 39 wpa_msg(drv->ctx, MSG_INFO, WPA_EVENT_DRIVER_STATE "HANGED"); 40 } 41} 42 43static void wpa_driver_notify_country_change(void *ctx, char *cmd) 44{ 45 if ((os_strncasecmp(cmd, "COUNTRY", 7) == 0) || 46 (os_strncasecmp(cmd, "SETBAND", 7) == 0)) { 47 union wpa_event_data event; 48 49 os_memset(&event, 0, sizeof(event)); 50 event.channel_list_changed.initiator = REGDOM_SET_BY_USER; 51 if (os_strncasecmp(cmd, "COUNTRY", 7) == 0) { 52 event.channel_list_changed.type = REGDOM_TYPE_COUNTRY; 53 if (os_strlen(cmd) > 9) { 54 event.channel_list_changed.alpha2[0] = cmd[8]; 55 event.channel_list_changed.alpha2[1] = cmd[9]; 56 } 57 } else { 58 event.channel_list_changed.type = REGDOM_TYPE_UNKNOWN; 59 } 60 wpa_supplicant_event(ctx, EVENT_CHANNEL_LIST_CHANGED, &event); 61 } 62} 63 64int wpa_driver_nl80211_driver_cmd(void *priv, char *cmd, char *buf, 65 size_t buf_len ) 66{ 67 struct i802_bss *bss = priv; 68 struct wpa_driver_nl80211_data *drv = bss->drv; 69 struct ifreq ifr; 70 android_wifi_priv_cmd priv_cmd; 71 int ret = 0; 72 73 if (bss->ifindex <= 0 && bss->wdev_id > 0) { 74 /* DRIVER CMD received on the DEDICATED P2P Interface which doesn't 75 * have an NETDEVICE associated with it. So we have to re-route the 76 * command to the parent NETDEVICE 77 */ 78 struct wpa_supplicant *wpa_s = (struct wpa_supplicant *)(drv->ctx); 79 80 wpa_printf(MSG_DEBUG, "Re-routing DRIVER cmd to parent iface"); 81 if (wpa_s && wpa_s->parent) { 82 /* Update the nl80211 pointers corresponding to parent iface */ 83 bss = wpa_s->parent->drv_priv; 84 drv = bss->drv; 85 wpa_printf(MSG_DEBUG, "Re-routing command to iface: %s" 86 " cmd (%s)", bss->ifname, cmd); 87 } 88 } 89 90 if (os_strcasecmp(cmd, "STOP") == 0) { 91 linux_set_iface_flags(drv->global->ioctl_sock, bss->ifname, 0); 92 wpa_msg(drv->ctx, MSG_INFO, WPA_EVENT_DRIVER_STATE "STOPPED"); 93 } else if (os_strcasecmp(cmd, "START") == 0) { 94 linux_set_iface_flags(drv->global->ioctl_sock, bss->ifname, 1); 95 wpa_msg(drv->ctx, MSG_INFO, WPA_EVENT_DRIVER_STATE "STARTED"); 96 } else if (os_strcasecmp(cmd, "MACADDR") == 0) { 97 u8 macaddr[ETH_ALEN] = {}; 98 99 ret = linux_get_ifhwaddr(drv->global->ioctl_sock, bss->ifname, macaddr); 100 if (!ret) 101 ret = os_snprintf(buf, buf_len, 102 "Macaddr = " MACSTR "\n", MAC2STR(macaddr)); 103 } else { /* Use private command */ 104 os_memcpy(buf, cmd, strlen(cmd) + 1); 105 memset(&ifr, 0, sizeof(ifr)); 106 memset(&priv_cmd, 0, sizeof(priv_cmd)); 107 os_strlcpy(ifr.ifr_name, bss->ifname, IFNAMSIZ); 108 109#ifdef BCMDHD_64_BIT_IPC 110 priv_cmd.bufaddr = (u64)(uintptr_t)buf; 111#else 112 priv_cmd.bufaddr = buf; 113#endif 114 priv_cmd.used_len = buf_len; 115 priv_cmd.total_len = buf_len; 116 ifr.ifr_data = &priv_cmd; 117 118 if ((ret = ioctl(drv->global->ioctl_sock, SIOCDEVPRIVATE + 1, &ifr)) < 0) { 119 wpa_printf(MSG_ERROR, "%s: failed to issue private command: %s", __func__, cmd); 120 wpa_driver_send_hang_msg(drv); 121 } else { 122 drv_errors = 0; 123 ret = 0; 124 if ((os_strcasecmp(cmd, "LINKSPEED") == 0) || 125 (os_strcasecmp(cmd, "RSSI") == 0) || 126 (os_strcasecmp(cmd, "GETBAND") == 0) || 127 (os_strncasecmp(cmd, "WLS_BATCHING", 12) == 0)) 128 ret = strlen(buf); 129 wpa_driver_notify_country_change(drv->ctx, cmd); 130 wpa_printf(MSG_DEBUG, "%s %s len = %d, %zu", __func__, buf, ret, strlen(buf)); 131 } 132 } 133 return ret; 134} 135 136int wpa_driver_set_p2p_noa(void *priv, u8 count, int start, int duration) 137{ 138 char buf[MAX_DRV_CMD_SIZE]; 139 140 memset(buf, 0, sizeof(buf)); 141 wpa_printf(MSG_DEBUG, "%s: Entry", __func__); 142 snprintf(buf, sizeof(buf), "P2P_SET_NOA %d %d %d", count, start, duration); 143 return wpa_driver_nl80211_driver_cmd(priv, buf, buf, strlen(buf)+1); 144} 145 146int wpa_driver_get_p2p_noa(void *priv __unused, u8 *buf __unused, size_t len __unused) 147{ 148 /* Return 0 till we handle p2p_presence request completely in the driver */ 149 return 0; 150} 151 152int wpa_driver_set_p2p_ps(void *priv, int legacy_ps, int opp_ps, int ctwindow) 153{ 154 char buf[MAX_DRV_CMD_SIZE]; 155 156 memset(buf, 0, sizeof(buf)); 157 wpa_printf(MSG_DEBUG, "%s: Entry", __func__); 158 snprintf(buf, sizeof(buf), "P2P_SET_PS %d %d %d", legacy_ps, opp_ps, ctwindow); 159 return wpa_driver_nl80211_driver_cmd(priv, buf, buf, strlen(buf) + 1); 160} 161 162int wpa_driver_set_ap_wps_p2p_ie(void *priv, const struct wpabuf *beacon, 163 const struct wpabuf *proberesp, 164 const struct wpabuf *assocresp) 165{ 166 char *buf; 167 const struct wpabuf *ap_wps_p2p_ie = NULL; 168 169 char *_cmd = "SET_AP_WPS_P2P_IE"; 170 char *pbuf; 171 int ret = 0; 172 int i, buf_len; 173 struct cmd_desc { 174 int cmd; 175 const struct wpabuf *src; 176 } cmd_arr[] = { 177 {0x1, beacon}, 178 {0x2, proberesp}, 179 {0x4, assocresp}, 180 {-1, NULL} 181 }; 182 183 wpa_printf(MSG_DEBUG, "%s: Entry", __func__); 184 for (i = 0; cmd_arr[i].cmd != -1; i++) { 185 ap_wps_p2p_ie = cmd_arr[i].src; 186 if (ap_wps_p2p_ie) { 187 buf_len = strlen(_cmd) + 3 + wpabuf_len(ap_wps_p2p_ie); 188 buf = os_zalloc(buf_len); 189 if (NULL == buf) { 190 wpa_printf(MSG_ERROR, "%s: Out of memory", 191 __func__); 192 ret = -1; 193 break; 194 } 195 } else { 196 continue; 197 } 198 pbuf = buf; 199 pbuf += snprintf(pbuf, buf_len - wpabuf_len(ap_wps_p2p_ie), 200 "%s %d",_cmd, cmd_arr[i].cmd); 201 *pbuf++ = '\0'; 202 os_memcpy(pbuf, wpabuf_head(ap_wps_p2p_ie), wpabuf_len(ap_wps_p2p_ie)); 203 ret = wpa_driver_nl80211_driver_cmd(priv, buf, buf, buf_len); 204 os_free(buf); 205 if (ret < 0) 206 break; 207 } 208 209 return ret; 210} 211