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
vnt_key_init_table(struct vnt_private * priv)24 int 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
vnt_set_keymode(struct ieee80211_hw * hw,u8 * mac_addr,struct ieee80211_key_conf * key,u32 key_type,u32 mode,bool onfly_latch)36 static 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 break;
87 default:
88 return -EINVAL;
89 }
90
91 if (onfly_latch)
92 key_mode |= VNT_KEY_ONFLY;
93
94 if (mode == KEY_CTL_WEP) {
95 if (key->keylen == WLAN_KEY_LEN_WEP40)
96 key->key[15] &= 0x7f;
97 if (key->keylen == WLAN_KEY_LEN_WEP104)
98 key->key[15] |= 0x80;
99 }
100
101 vnt_mac_set_keyentry(priv, key_mode, entry, key_inx, bssid, key->key);
102
103 return 0;
104 }
105
vnt_set_keys(struct ieee80211_hw * hw,struct ieee80211_sta * sta,struct ieee80211_vif * vif,struct ieee80211_key_conf * key)106 int vnt_set_keys(struct ieee80211_hw *hw, struct ieee80211_sta *sta,
107 struct ieee80211_vif *vif, struct ieee80211_key_conf *key)
108 {
109 struct vnt_private *priv = hw->priv;
110 u8 *mac_addr = NULL;
111 u8 key_dec_mode = 0;
112 int ret = 0, u;
113
114 if (sta)
115 mac_addr = &sta->addr[0];
116
117 switch (key->cipher) {
118 case 0:
119 for (u = 0 ; u < MAX_KEY_TABLE; u++)
120 vnt_mac_disable_keyentry(priv, u);
121 return ret;
122
123 case WLAN_CIPHER_SUITE_WEP40:
124 case WLAN_CIPHER_SUITE_WEP104:
125 for (u = 0; u < MAX_KEY_TABLE; u++)
126 vnt_mac_disable_keyentry(priv, u);
127
128 vnt_set_keymode(hw, mac_addr, key, VNT_KEY_DEFAULTKEY,
129 KEY_CTL_WEP, true);
130
131 key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
132
133 return ret;
134 case WLAN_CIPHER_SUITE_TKIP:
135 key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
136 key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
137
138 key_dec_mode = KEY_CTL_TKIP;
139
140 break;
141 case WLAN_CIPHER_SUITE_CCMP:
142 if (priv->local_id <= MAC_REVISION_A1)
143 return -EINVAL;
144
145 key_dec_mode = KEY_CTL_CCMP;
146
147 key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
148 }
149
150 if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE)
151 vnt_set_keymode(hw, mac_addr, key, VNT_KEY_PAIRWISE,
152 key_dec_mode, true);
153 else
154 vnt_set_keymode(hw, mac_addr, key, VNT_KEY_GROUP_ADDRESS,
155 key_dec_mode, true);
156
157 return 0;
158 }
159