Check for SYS/GL during library init. Reason is that
[AROS.git] / workbench / devs / networks / atheros5000 / hal / ar5210 / ar5210_keycache.c
blob85de9e51a642004ceeb0b94dd0bbd68b77c85520
1 /*
2 * Copyright (c) 2002-2008 Sam Leffler, Errno Consulting
3 * Copyright (c) 2002-2004 Atheros Communications, Inc.
5 * Permission to use, copy, modify, and/or distribute this software for any
6 * purpose with or without fee is hereby granted, provided that the above
7 * copyright notice and this permission notice appear in all copies.
9 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
10 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
11 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
12 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
13 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
14 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
15 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 * $Id$
19 #include "opt_ah.h"
21 #ifdef AH_SUPPORT_AR5210
23 #include "ah.h"
24 #include "ah_internal.h"
26 #include "ar5210/ar5210.h"
27 #include "ar5210/ar5210reg.h"
29 #define AR_KEYTABLE_SIZE 64
30 #define KEY_XOR 0xaa
33 * Return the size of the hardware key cache.
35 u_int
36 ar5210GetKeyCacheSize(struct ath_hal *ah)
38 return AR_KEYTABLE_SIZE;
42 * Return the size of the hardware key cache.
44 HAL_BOOL
45 ar5210IsKeyCacheEntryValid(struct ath_hal *ah, uint16_t entry)
47 if (entry < AR_KEYTABLE_SIZE) {
48 uint32_t val = OS_REG_READ(ah, AR_KEYTABLE_MAC1(entry));
49 if (val & AR_KEYTABLE_VALID)
50 return AH_TRUE;
52 return AH_FALSE;
56 * Clear the specified key cache entry.
58 HAL_BOOL
59 ar5210ResetKeyCacheEntry(struct ath_hal *ah, uint16_t entry)
61 if (entry < AR_KEYTABLE_SIZE) {
62 OS_REG_WRITE(ah, AR_KEYTABLE_KEY0(entry), 0);
63 OS_REG_WRITE(ah, AR_KEYTABLE_KEY1(entry), 0);
64 OS_REG_WRITE(ah, AR_KEYTABLE_KEY2(entry), 0);
65 OS_REG_WRITE(ah, AR_KEYTABLE_KEY3(entry), 0);
66 OS_REG_WRITE(ah, AR_KEYTABLE_KEY4(entry), 0);
67 OS_REG_WRITE(ah, AR_KEYTABLE_TYPE(entry), 0);
68 OS_REG_WRITE(ah, AR_KEYTABLE_MAC0(entry), 0);
69 OS_REG_WRITE(ah, AR_KEYTABLE_MAC1(entry), 0);
70 return AH_TRUE;
72 return AH_FALSE;
76 * Sets the mac part of the specified key cache entry and mark it valid.
78 HAL_BOOL
79 ar5210SetKeyCacheEntryMac(struct ath_hal *ah, uint16_t entry, const uint8_t *mac)
81 uint32_t macHi, macLo;
83 if (entry < AR_KEYTABLE_SIZE) {
85 * Set MAC address -- shifted right by 1. MacLo is
86 * the 4 MSBs, and MacHi is the 2 LSBs.
88 if (mac != AH_NULL) {
89 macHi = (mac[5] << 8) | mac[4];
90 macLo = (mac[3] << 24)| (mac[2] << 16)
91 | (mac[1] << 8) | mac[0];
92 macLo >>= 1;
93 macLo |= (macHi & 1) << 31; /* carry */
94 macHi >>= 1;
95 } else {
96 macLo = macHi = 0;
99 OS_REG_WRITE(ah, AR_KEYTABLE_MAC0(entry), macLo);
100 OS_REG_WRITE(ah, AR_KEYTABLE_MAC1(entry),
101 macHi | AR_KEYTABLE_VALID);
102 return AH_TRUE;
104 return AH_FALSE;
108 * Sets the contents of the specified key cache entry.
110 HAL_BOOL
111 ar5210SetKeyCacheEntry(struct ath_hal *ah, uint16_t entry,
112 const HAL_KEYVAL *k, const uint8_t *mac, int xorKey)
114 uint32_t key0, key1, key2, key3, key4;
115 uint32_t keyType;
116 uint32_t xorMask= xorKey ?
117 (KEY_XOR << 24 | KEY_XOR << 16 | KEY_XOR << 8 | KEY_XOR) : 0;
119 if (entry >= AR_KEYTABLE_SIZE)
120 return AH_FALSE;
121 if (k->kv_type != HAL_CIPHER_WEP) {
122 HALDEBUG(ah, HAL_DEBUG_ANY, "%s: cipher %u not supported\n",
123 __func__, k->kv_type);
124 return AH_FALSE;
127 /* NB: only WEP supported */
128 if (k->kv_len < 40 / NBBY)
129 return AH_FALSE;
130 if (k->kv_len <= 40 / NBBY)
131 keyType = AR_KEYTABLE_TYPE_40;
132 else if (k->kv_len <= 104 / NBBY)
133 keyType = AR_KEYTABLE_TYPE_104;
134 else
135 keyType = AR_KEYTABLE_TYPE_128;
137 key0 = LE_READ_4(k->kv_val+0) ^ xorMask;
138 key1 = (LE_READ_2(k->kv_val+4) ^ xorMask) & 0xffff;
139 key2 = LE_READ_4(k->kv_val+6) ^ xorMask;
140 key3 = (LE_READ_2(k->kv_val+10) ^ xorMask) & 0xffff;
141 key4 = LE_READ_4(k->kv_val+12) ^ xorMask;
142 if (k->kv_len <= 104 / NBBY)
143 key4 &= 0xff;
146 * Note: WEP key cache hardware requires that each double-word
147 * pair be written in even/odd order (since the destination is
148 * a 64-bit register). Don't reorder these writes w/o
149 * understanding this!
151 OS_REG_WRITE(ah, AR_KEYTABLE_KEY0(entry), key0);
152 OS_REG_WRITE(ah, AR_KEYTABLE_KEY1(entry), key1);
153 OS_REG_WRITE(ah, AR_KEYTABLE_KEY2(entry), key2);
154 OS_REG_WRITE(ah, AR_KEYTABLE_KEY3(entry), key3);
155 OS_REG_WRITE(ah, AR_KEYTABLE_KEY4(entry), key4);
156 OS_REG_WRITE(ah, AR_KEYTABLE_TYPE(entry), keyType);
157 return ar5210SetKeyCacheEntryMac(ah, entry, mac);
159 #endif /* AH_SUPPORT_AR5210 */