drivers/staging/vt6656/key.c

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