| /* |
| * WPA Supplicant - Driver interaction with Atmel Wireless LAN drivers |
| * Copyright (c) 2000-2005, ATMEL Corporation |
| * Copyright (c) 2004-2007, Jouni Malinen <[email protected]> |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| * |
| * Alternatively, this software may be distributed under the terms of BSD |
| * license. |
| * |
| * See README and COPYING for more details. |
| */ |
| |
| /****************************************************************************** |
| Copyright 2000-2001 ATMEL Corporation. |
| |
| WPA Supplicant - driver interaction with Atmel Wireless lan drivers. |
| |
| This is free software; you can redistribute it and/or modify |
| it under the terms of the GNU General Public License as published by |
| the Free Software Foundation; either version 2 of the License, or |
| (at your option) any later version. |
| |
| This program is distributed in the hope that it will be useful, |
| but WITHOUT ANY WARRANTY; without even the implied warranty of |
| MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| GNU General Public License for more details. |
| |
| You should have received a copy of the GNU General Public License |
| along with Atmel wireless lan drivers; if not, write to the Free Software |
| Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
| |
| ******************************************************************************/ |
| |
| /* |
| * Alternatively, this software may be distributed under the terms of BSD |
| * license. |
| */ |
| |
| #include "includes.h" |
| #include <sys/ioctl.h> |
| |
| #include "wireless_copy.h" |
| #include "common.h" |
| #include "driver.h" |
| #include "driver_wext.h" |
| #include "wpa_supplicant.h" |
| |
| struct wpa_driver_atmel_data { |
| void *wext; /* private data for driver_wext */ |
| void *ctx; |
| char ifname[IFNAMSIZ + 1]; |
| int sock; |
| }; |
| |
| |
| #define ATMEL_WPA_IOCTL (SIOCIWFIRSTPRIV + 2) |
| #define ATMEL_WPA_IOCTL_PARAM (SIOCIWFIRSTPRIV + 3) |
| #define ATMEL_WPA_IOCTL_GET_PARAM (SIOCIWFIRSTPRIV + 4) |
| |
| |
| /* ATMEL_WPA_IOCTL ioctl() cmd: */ |
| enum { |
| SET_WPA_ENCRYPTION = 1, |
| SET_CIPHER_SUITES = 2, |
| MLME_STA_DEAUTH = 3, |
| MLME_STA_DISASSOC = 4 |
| }; |
| |
| /* ATMEL_WPA_IOCTL_PARAM ioctl() cmd: */ |
| enum { |
| ATMEL_PARAM_WPA = 1, |
| ATMEL_PARAM_PRIVACY_INVOKED = 2, |
| ATMEL_PARAM_WPA_TYPE = 3 |
| }; |
| |
| #define MAX_KEY_LENGTH 40 |
| |
| struct atmel_param{ |
| unsigned char sta_addr[6]; |
| int cmd; |
| u8 alg; |
| u8 key_idx; |
| u8 set_tx; |
| u8 seq[8]; |
| u8 seq_len; |
| u16 key_len; |
| u8 key[MAX_KEY_LENGTH]; |
| struct{ |
| int reason_code; |
| u8 state; |
| }mlme; |
| u8 pairwise_suite; |
| u8 group_suite; |
| u8 key_mgmt_suite; |
| }; |
| |
| |
| |
| static int atmel_ioctl(struct wpa_driver_atmel_data *drv, |
| struct atmel_param *param, |
| int len, int show_err) |
| { |
| struct iwreq iwr; |
| |
| os_memset(&iwr, 0, sizeof(iwr)); |
| os_strncpy(iwr.ifr_name, drv->ifname, IFNAMSIZ); |
| iwr.u.data.pointer = (caddr_t) param; |
| iwr.u.data.length = len; |
| |
| if (ioctl(drv->sock, ATMEL_WPA_IOCTL, &iwr) < 0) { |
| int ret; |
| ret = errno; |
| if (show_err) |
| perror("ioctl[ATMEL_WPA_IOCTL]"); |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| |
| static int atmel2param(struct wpa_driver_atmel_data *drv, int param, int value) |
| { |
| struct iwreq iwr; |
| int *i, ret = 0; |
| |
| os_memset(&iwr, 0, sizeof(iwr)); |
| os_strncpy(iwr.ifr_name, drv->ifname, IFNAMSIZ); |
| i = (int *) iwr.u.name; |
| *i++ = param; |
| *i++ = value; |
| |
| if (ioctl(drv->sock, ATMEL_WPA_IOCTL_PARAM, &iwr) < 0) { |
| perror("ioctl[ATMEL_WPA_IOCTL_PARAM]"); |
| ret = -1; |
| } |
| return ret; |
| } |
| |
| |
| #if 0 |
| static int wpa_driver_atmel_set_wpa_ie(struct wpa_driver_atmel_data *drv, |
| const char *wpa_ie, size_t wpa_ie_len) |
| { |
| struct atmel_param *param; |
| int res; |
| size_t blen = ATMEL_GENERIC_ELEMENT_HDR_LEN + wpa_ie_len; |
| if (blen < sizeof(*param)) |
| blen = sizeof(*param); |
| |
| param = os_zalloc(blen); |
| if (param == NULL) |
| return -1; |
| |
| param->cmd = ATMEL_SET_GENERIC_ELEMENT; |
| param->u.generic_elem.len = wpa_ie_len; |
| os_memcpy(param->u.generic_elem.data, wpa_ie, wpa_ie_len); |
| res = atmel_ioctl(drv, param, blen, 1); |
| |
| os_free(param); |
| |
| return res; |
| } |
| #endif |
| |
| |
| static int wpa_driver_atmel_set_wpa(void *priv, int enabled) |
| { |
| struct wpa_driver_atmel_data *drv = priv; |
| int ret = 0; |
| |
| printf("wpa_driver_atmel_set_wpa %s\n", drv->ifname); |
| |
| wpa_printf(MSG_DEBUG, "%s: enabled=%d", __FUNCTION__, enabled); |
| |
| #if 0 |
| if (!enabled && wpa_driver_atmel_set_wpa_ie(drv, NULL, 0) < 0) |
| ret = -1; |
| #endif |
| if (atmel2param(drv, ATMEL_PARAM_PRIVACY_INVOKED, enabled) < 0) |
| ret = -1; |
| if (atmel2param(drv, ATMEL_PARAM_WPA, enabled) < 0) |
| ret = -1; |
| |
| return ret; |
| } |
| |
| |
| static int wpa_driver_atmel_set_key(void *priv, wpa_alg alg, |
| const u8 *addr, int key_idx, |
| int set_tx, const u8 *seq, size_t seq_len, |
| const u8 *key, size_t key_len) |
| { |
| struct wpa_driver_atmel_data *drv = priv; |
| int ret = 0; |
| struct atmel_param *param; |
| u8 *buf; |
| u8 alg_type; |
| |
| size_t blen; |
| char *alg_name; |
| |
| switch (alg) { |
| case WPA_ALG_NONE: |
| alg_name = "none"; |
| alg_type = 0; |
| break; |
| case WPA_ALG_WEP: |
| alg_name = "WEP"; |
| alg_type = 1; |
| break; |
| case WPA_ALG_TKIP: |
| alg_name = "TKIP"; |
| alg_type = 2; |
| break; |
| case WPA_ALG_CCMP: |
| alg_name = "CCMP"; |
| alg_type = 3; |
| break; |
| default: |
| return -1; |
| } |
| |
| wpa_printf(MSG_DEBUG, "%s: alg=%s key_idx=%d set_tx=%d seq_len=%lu " |
| "key_len=%lu", __FUNCTION__, alg_name, key_idx, set_tx, |
| (unsigned long) seq_len, (unsigned long) key_len); |
| |
| if (seq_len > 8) |
| return -2; |
| |
| blen = sizeof(*param) + key_len; |
| buf = os_zalloc(blen); |
| if (buf == NULL) |
| return -1; |
| |
| param = (struct atmel_param *) buf; |
| |
| param->cmd = SET_WPA_ENCRYPTION; |
| |
| if (addr == NULL) |
| os_memset(param->sta_addr, 0xff, ETH_ALEN); |
| else |
| os_memcpy(param->sta_addr, addr, ETH_ALEN); |
| |
| param->alg = alg_type; |
| param->key_idx = key_idx; |
| param->set_tx = set_tx; |
| os_memcpy(param->seq, seq, seq_len); |
| param->seq_len = seq_len; |
| param->key_len = key_len; |
| os_memcpy((u8 *)param->key, key, key_len); |
| |
| if (atmel_ioctl(drv, param, blen, 1)) { |
| wpa_printf(MSG_WARNING, "Failed to set encryption."); |
| /* TODO: show key error*/ |
| ret = -1; |
| } |
| os_free(buf); |
| |
| return ret; |
| } |
| |
| |
| static int wpa_driver_atmel_set_countermeasures(void *priv, |
| int enabled) |
| { |
| /* FIX */ |
| printf("wpa_driver_atmel_set_countermeasures - not yet " |
| "implemented\n"); |
| return 0; |
| } |
| |
| |
| static int wpa_driver_atmel_set_drop_unencrypted(void *priv, |
| int enabled) |
| { |
| /* FIX */ |
| printf("wpa_driver_atmel_set_drop_unencrypted - not yet " |
| "implemented\n"); |
| return 0; |
| } |
| |
| |
| static int wpa_driver_atmel_mlme(void *priv, const u8 *addr, int cmd, |
| int reason_code) |
| { |
| struct wpa_driver_atmel_data *drv = priv; |
| struct atmel_param param; |
| int ret; |
| int mgmt_error = 0xaa; |
| |
| os_memset(¶m, 0, sizeof(param)); |
| os_memcpy(param.sta_addr, addr, ETH_ALEN); |
| param.cmd = cmd; |
| param.mlme.reason_code = reason_code; |
| param.mlme.state = mgmt_error; |
| ret = atmel_ioctl(drv, ¶m, sizeof(param), 1); |
| return ret; |
| } |
| |
| |
| #if 0 |
| static int wpa_driver_atmel_set_suites(struct wpa_driver_atmel_data *drv, |
| u8 pairwise_suite, u8 group_suite, |
| u8 key_mgmt_suite) |
| { |
| struct atmel_param param; |
| int ret; |
| |
| os_memset(¶m, 0, sizeof(param)); |
| param.cmd = SET_CIPHER_SUITES; |
| param.pairwise_suite = pairwise_suite; |
| param.group_suite = group_suite; |
| param.key_mgmt_suite = key_mgmt_suite; |
| |
| ret = atmel_ioctl(drv, ¶m, sizeof(param), 1); |
| return ret; |
| } |
| #endif |
| |
| |
| static int wpa_driver_atmel_deauthenticate(void *priv, const u8 *addr, |
| int reason_code) |
| { |
| struct wpa_driver_atmel_data *drv = priv; |
| printf("wpa_driver_atmel_deauthenticate\n"); |
| wpa_printf(MSG_DEBUG, "%s", __FUNCTION__); |
| return wpa_driver_atmel_mlme(drv, addr, MLME_STA_DEAUTH, |
| reason_code); |
| |
| } |
| |
| |
| static int wpa_driver_atmel_disassociate(void *priv, const u8 *addr, |
| int reason_code) |
| { |
| struct wpa_driver_atmel_data *drv = priv; |
| printf("wpa_driver_atmel_disassociate\n"); |
| wpa_printf(MSG_DEBUG, "%s", __FUNCTION__); |
| return wpa_driver_atmel_mlme(drv, addr, MLME_STA_DISASSOC, |
| reason_code); |
| |
| } |
| |
| |
| #if 0 |
| /* Atmel driver uses specific values for each cipher suite */ |
| static int convertSuiteToDriver(wpa_cipher suite) |
| { |
| u8 suite_type; |
| |
| switch(suite) { |
| case CIPHER_NONE: |
| suite_type = 0; |
| break; |
| case CIPHER_WEP40: |
| suite_type = 1; |
| break; |
| case CIPHER_TKIP: |
| suite_type = 2; |
| break; |
| case CIPHER_WEP104: |
| suite_type = 5; |
| break; |
| case CIPHER_CCMP: |
| suite_type = 3; |
| break; |
| default: |
| suite_type = 2; |
| } |
| |
| return suite_type; |
| |
| } |
| #endif |
| |
| static int |
| wpa_driver_atmel_associate(void *priv, |
| struct wpa_driver_associate_params *params) |
| { |
| struct wpa_driver_atmel_data *drv = priv; |
| int ret = 0; |
| #if 0 |
| u8 pairwise_suite_driver; |
| u8 group_suite_driver; |
| u8 key_mgmt_suite_driver; |
| |
| pairwise_suite_driver = convertSuiteToDriver(params->pairwise_suite); |
| group_suite_driver = convertSuiteToDriver(params->group_suite); |
| key_mgmt_suite_driver = convertSuiteToDriver(params->key_mgmt_suite); |
| |
| if (wpa_driver_atmel_set_suites(drv, pairwise_suite_driver, |
| group_suite_driver, |
| key_mgmt_suite_driver) < 0){ |
| printf("wpa_driver_atmel_set_suites.\n"); |
| ret = -1; |
| } |
| if (wpa_driver_wext_set_freq(drv->wext, params->freq) < 0) { |
| printf("wpa_driver_atmel_set_freq.\n"); |
| ret = -1; |
| } |
| #endif |
| if (wpa_driver_wext_set_ssid(drv->wext, params->ssid, params->ssid_len) |
| < 0) { |
| printf("FAILED : wpa_driver_atmel_set_ssid.\n"); |
| ret = -1; |
| } |
| if (wpa_driver_wext_set_bssid(drv->wext, params->bssid) < 0) { |
| printf("FAILED : wpa_driver_atmel_set_bssid.\n"); |
| ret = -1; |
| } |
| |
| return ret; |
| } |
| |
| |
| static int wpa_driver_atmel_get_bssid(void *priv, u8 *bssid) |
| { |
| struct wpa_driver_atmel_data *drv = priv; |
| return wpa_driver_wext_get_bssid(drv->wext, bssid); |
| } |
| |
| |
| static int wpa_driver_atmel_get_ssid(void *priv, u8 *ssid) |
| { |
| struct wpa_driver_atmel_data *drv = priv; |
| return wpa_driver_wext_get_ssid(drv->wext, ssid); |
| } |
| |
| |
| static int wpa_driver_atmel_scan(void *priv, const u8 *ssid, size_t ssid_len) |
| { |
| struct wpa_driver_atmel_data *drv = priv; |
| return wpa_driver_wext_scan(drv->wext, ssid, ssid_len); |
| } |
| |
| |
| static int wpa_driver_atmel_get_scan_results(void *priv, |
| struct wpa_scan_result *results, |
| size_t max_size) |
| { |
| struct wpa_driver_atmel_data *drv = priv; |
| return wpa_driver_wext_get_scan_results(drv->wext, results, max_size); |
| } |
| |
| |
| static int wpa_driver_atmel_set_operstate(void *priv, int state) |
| { |
| struct wpa_driver_atmel_data *drv = priv; |
| return wpa_driver_wext_set_operstate(drv->wext, state); |
| } |
| |
| |
| static void * wpa_driver_atmel_init(void *ctx, const char *ifname) |
| { |
| struct wpa_driver_atmel_data *drv; |
| |
| drv = os_zalloc(sizeof(*drv)); |
| if (drv == NULL) |
| return NULL; |
| drv->wext = wpa_driver_wext_init(ctx, ifname); |
| if (drv->wext == NULL) { |
| os_free(drv); |
| return NULL; |
| } |
| |
| drv->ctx = ctx; |
| os_strncpy(drv->ifname, ifname, sizeof(drv->ifname)); |
| drv->sock = socket(PF_INET, SOCK_DGRAM, 0); |
| if (drv->sock < 0) { |
| wpa_driver_wext_deinit(drv->wext); |
| os_free(drv); |
| return NULL; |
| } |
| |
| return drv; |
| } |
| |
| |
| static void wpa_driver_atmel_deinit(void *priv) |
| { |
| struct wpa_driver_atmel_data *drv = priv; |
| wpa_driver_wext_deinit(drv->wext); |
| close(drv->sock); |
| os_free(drv); |
| } |
| |
| |
| const struct wpa_driver_ops wpa_driver_atmel_ops = { |
| .name = "atmel", |
| .desc = "ATMEL AT76C5XXx (USB, PCMCIA)", |
| .get_bssid = wpa_driver_atmel_get_bssid, |
| .get_ssid = wpa_driver_atmel_get_ssid, |
| .set_wpa = wpa_driver_atmel_set_wpa, |
| .set_key = wpa_driver_atmel_set_key, |
| .init = wpa_driver_atmel_init, |
| .deinit = wpa_driver_atmel_deinit, |
| .set_countermeasures = wpa_driver_atmel_set_countermeasures, |
| .set_drop_unencrypted = wpa_driver_atmel_set_drop_unencrypted, |
| .scan = wpa_driver_atmel_scan, |
| .get_scan_results = wpa_driver_atmel_get_scan_results, |
| .deauthenticate = wpa_driver_atmel_deauthenticate, |
| .disassociate = wpa_driver_atmel_disassociate, |
| .associate = wpa_driver_atmel_associate, |
| .set_operstate = wpa_driver_atmel_set_operstate, |
| }; |