LXR linux/drivers/staging/vt6656/key.c

   1// SPDX-License-Identifier: GPL-2.0+
   2/*
   3 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
   4 * All rights reserved.
   5 *
   6 * File: key.c
   7 *
   8 * Purpose: Implement functions for 802.11i Key management
   9 *
  10 * Author: Jerry Chen
  11 *
  12 * Date: May 29, 2003
  13 *
  14 * Functions:
  15 *
  16 * Revision History:
  17 *
  18 */
  19
  20#include "mac.h"
  21#include "key.h"
  22#include "usbpipe.h"
  23
  24int vnt_key_init_table(struct vnt_private *priv)
  25{
  26        u8 i;
  27        u8 data[MAX_KEY_TABLE];
  28
  29        for (i = 0; i < MAX_KEY_TABLE; i++)
  30                data[i] = i;
  31
  32        return vnt_control_out(priv, MESSAGE_TYPE_CLRKEYENTRY,
  33                        0, 0, ARRAY_SIZE(data), data);
  34}
  35
  36static int vnt_set_keymode(struct ieee80211_hw *hw, u8 *mac_addr,
  37                           struct ieee80211_key_conf *key, u32 key_type,
  38                           u32 mode, bool onfly_latch)
  39{
  40        struct vnt_private *priv = hw->priv;
  41        u8 broadcast[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
  42        u16 key_mode = 0;
  43        u32 entry = 0;
  44        u8 *bssid;
  45        u8 key_inx = key->keyidx;
  46        u8 i;
  47
  48        if (mac_addr)
  49                bssid = mac_addr;
  50        else
  51                bssid = &broadcast[0];
  52
  53        if (key_type != VNT_KEY_DEFAULTKEY) {
  54                for (i = 0; i < (MAX_KEY_TABLE - 1); i++) {
  55                        if (!test_bit(i, &priv->key_entry_inuse)) {
  56                                set_bit(i, &priv->key_entry_inuse);
  57
  58                                key->hw_key_idx = i;
  59                                entry = key->hw_key_idx;
  60                                break;
  61                        }
  62                }
  63        }
  64
  65        switch (key_type) {
  66        case VNT_KEY_DEFAULTKEY:
  67                /* default key last entry */
  68                entry = MAX_KEY_TABLE - 1;
  69                key->hw_key_idx = entry;
  70                /* fall through */
  71        case VNT_KEY_ALLGROUP:
  72                key_mode |= VNT_KEY_ALLGROUP;
  73                if (onfly_latch)
  74                        key_mode |= VNT_KEY_ONFLY_ALL;
  75                /* fall through */
  76        case VNT_KEY_GROUP_ADDRESS:
  77                key_mode |= mode;
  78                /* fall through */
  79        case VNT_KEY_GROUP:
  80                key_mode |= (mode << 4);
  81                key_mode |= VNT_KEY_GROUP;
  82                break;
  83        case  VNT_KEY_PAIRWISE:
  84                key_mode |= mode;
  85                key_inx = 4;
  86                /* Don't save entry for pairwise key for station mode */
  87                if (priv->op_mode == NL80211_IFTYPE_STATION)
  88                        clear_bit(entry, &priv->key_entry_inuse);
  89                break;
  90        default:
  91                return -EINVAL;
  92        }
  93
  94        if (onfly_latch)
  95                key_mode |= VNT_KEY_ONFLY;
  96
  97        if (mode == KEY_CTL_WEP) {
  98                if (key->keylen == WLAN_KEY_LEN_WEP40)
  99                        key->key[15] &= 0x7f;
 100                if (key->keylen == WLAN_KEY_LEN_WEP104)
 101                        key->key[15] |= 0x80;
 102        }
 103
 104        vnt_mac_set_keyentry(priv, key_mode, entry, key_inx, bssid, key->key);
 105
 106        return 0;
 107}
 108
 109int vnt_set_keys(struct ieee80211_hw *hw, struct ieee80211_sta *sta,
 110                 struct ieee80211_vif *vif, struct ieee80211_key_conf *key)
 111{
 112        struct ieee80211_bss_conf *conf = &vif->bss_conf;
 113        struct vnt_private *priv = hw->priv;
 114        u8 *mac_addr = NULL;
 115        u8 key_dec_mode = 0;
 116        int ret = 0, u;
 117
 118        if (sta)
 119                mac_addr = &sta->addr[0];
 120
 121        switch (key->cipher) {
 122        case 0:
 123                for (u = 0 ; u < MAX_KEY_TABLE; u++)
 124                        vnt_mac_disable_keyentry(priv, u);
 125                return ret;
 126
 127        case WLAN_CIPHER_SUITE_WEP40:
 128        case WLAN_CIPHER_SUITE_WEP104:
 129                for (u = 0; u < MAX_KEY_TABLE; u++)
 130                        vnt_mac_disable_keyentry(priv, u);
 131
 132                vnt_set_keymode(hw, mac_addr, key, VNT_KEY_DEFAULTKEY,
 133                                KEY_CTL_WEP, true);
 134
 135                key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
 136
 137                return ret;
 138        case WLAN_CIPHER_SUITE_TKIP:
 139                key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
 140                key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
 141
 142                key_dec_mode = KEY_CTL_TKIP;
 143
 144                break;
 145        case WLAN_CIPHER_SUITE_CCMP:
 146                if (priv->local_id <= MAC_REVISION_A1)
 147                        return -EINVAL;
 148
 149                key_dec_mode = KEY_CTL_CCMP;
 150
 151                key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
 152        }
 153
 154        if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE) {
 155                vnt_set_keymode(hw, mac_addr, key, VNT_KEY_PAIRWISE,
 156                                key_dec_mode, true);
 157        } else {
 158                vnt_set_keymode(hw, mac_addr, key, VNT_KEY_DEFAULTKEY,
 159                                key_dec_mode, true);
 160
 161                vnt_set_keymode(hw, (u8 *)conf->bssid, key,
 162                                VNT_KEY_GROUP_ADDRESS, key_dec_mode, true);
 163        }
 164
 165        return 0;
 166}
 167