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 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 *
19 *
20 * File: key.c
21 *
22 * Purpose: Implement functions for 802.11i Key management
23 *
24 * Author: Jerry Chen
25 *
26 * Date: May 29, 2003
27 *
28 */
29
30#include "tmacro.h"
31#include "key.h"
32#include "mac.h"
33
34int vnt_key_init_table(struct vnt_private *priv)
35{
36	u32 i;
37
38	for (i = 0; i < MAX_KEY_TABLE; i++)
39		MACvDisableKeyEntry(priv->PortOffset, i);
40
41	return 0;
42}
43
44static int vnt_set_keymode(struct ieee80211_hw *hw, u8 *mac_addr,
45	struct ieee80211_key_conf *key, u32 key_type, u32 mode,
46	bool onfly_latch)
47{
48	struct vnt_private *priv = hw->priv;
49	u8 broadcast[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
50	u16 key_mode = 0;
51	u32 entry = 0;
52	u8 *bssid;
53	u8 key_inx = key->keyidx;
54	u8 i;
55
56	if (mac_addr)
57		bssid = mac_addr;
58	else
59		bssid = &broadcast[0];
60
61	if (key_type != VNT_KEY_DEFAULTKEY) {
62		for (i = 0; i < (MAX_KEY_TABLE - 1); i++) {
63			if (!test_bit(i, &priv->key_entry_inuse)) {
64				set_bit(i, &priv->key_entry_inuse);
65
66				key->hw_key_idx = i;
67				entry = key->hw_key_idx;
68				break;
69			}
70		}
71	}
72
73	switch (key_type) {
74	/* fallthrough */
75	case VNT_KEY_DEFAULTKEY:
76		/* default key last entry */
77		entry = MAX_KEY_TABLE - 1;
78		key->hw_key_idx = entry;
79	case VNT_KEY_ALLGROUP:
80		key_mode |= VNT_KEY_ALLGROUP;
81		if (onfly_latch)
82			key_mode |= VNT_KEY_ONFLY_ALL;
83	case VNT_KEY_GROUP_ADDRESS:
84		key_mode |= mode;
85	case VNT_KEY_GROUP:
86		key_mode |= (mode << 4);
87		key_mode |= VNT_KEY_GROUP;
88		break;
89	case  VNT_KEY_PAIRWISE:
90		key_mode |= mode;
91		key_inx = 4;
92		break;
93	default:
94		return -EINVAL;
95	}
96
97	if (onfly_latch)
98		key_mode |= VNT_KEY_ONFLY;
99
100	if (mode == KEY_CTL_WEP) {
101		if (key->keylen == WLAN_KEY_LEN_WEP40)
102			key->key[15] &= 0x7f;
103		if (key->keylen == WLAN_KEY_LEN_WEP104)
104			key->key[15] |= 0x80;
105	}
106
107	MACvSetKeyEntry(priv->PortOffset, key_mode, entry, key_inx,
108			bssid, (u32 *)key->key, priv->byLocalID);
109
110	return 0;
111}
112
113int vnt_set_keys(struct ieee80211_hw *hw, struct ieee80211_sta *sta,
114		 struct ieee80211_vif *vif, struct ieee80211_key_conf *key)
115{
116	struct ieee80211_bss_conf *conf = &vif->bss_conf;
117	struct vnt_private *priv = hw->priv;
118	u8 *mac_addr = NULL;
119	u8 key_dec_mode = 0;
120	int ret = 0;
121	u32 u;
122
123	if (sta)
124		mac_addr = &sta->addr[0];
125
126	switch (key->cipher) {
127	case 0:
128		for (u = 0 ; u < MAX_KEY_TABLE; u++)
129			MACvDisableKeyEntry(priv->PortOffset, u);
130		return ret;
131
132	case WLAN_CIPHER_SUITE_WEP40:
133	case WLAN_CIPHER_SUITE_WEP104:
134		for (u = 0; u < MAX_KEY_TABLE; u++)
135			MACvDisableKeyEntry(priv->PortOffset, u);
136
137		vnt_set_keymode(hw, mac_addr,
138				key, VNT_KEY_DEFAULTKEY, KEY_CTL_WEP, true);
139
140		key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
141
142		return ret;
143	case WLAN_CIPHER_SUITE_TKIP:
144		key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
145		key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
146
147		key_dec_mode = KEY_CTL_TKIP;
148
149		break;
150	case WLAN_CIPHER_SUITE_CCMP:
151		key_dec_mode = KEY_CTL_CCMP;
152
153		key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
154	}
155
156	if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE) {
157		vnt_set_keymode(hw, mac_addr,
158				key, VNT_KEY_PAIRWISE, key_dec_mode, true);
159	} else {
160		vnt_set_keymode(hw, mac_addr,
161				key, VNT_KEY_DEFAULTKEY, key_dec_mode, true);
162
163		vnt_set_keymode(hw, (u8 *)conf->bssid,
164				key, VNT_KEY_GROUP_ADDRESS, key_dec_mode, true);
165	}
166
167	return 0;
168}
169