Greg Kroah-Hartman | 6b4c6ce | 2017-11-07 21:07:52 +0100 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 2 | /* |
| 3 | * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc. |
| 4 | * All rights reserved. |
| 5 | * |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 6 | * File: mac.c |
| 7 | * |
| 8 | * Purpose: MAC routines |
| 9 | * |
| 10 | * Author: Tevin Chen |
| 11 | * |
| 12 | * Date: May 21, 1996 |
| 13 | * |
| 14 | * Functions: |
| 15 | * |
| 16 | * Revision History: |
| 17 | */ |
| 18 | |
Aya Mahfouz | c5f9e99 | 2015-02-27 03:06:53 +0200 | [diff] [blame] | 19 | #include <linux/etherdevice.h> |
| 20 | |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 21 | #include "desc.h" |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 22 | #include "mac.h" |
Malcolm Priestley | 62c8526 | 2014-05-26 13:59:07 +0100 | [diff] [blame] | 23 | #include "usbpipe.h" |
Jim Lieb | 9d26d60 | 2009-08-12 14:54:08 -0700 | [diff] [blame] | 24 | |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 25 | /* |
| 26 | * Description: |
| 27 | * Write MAC Multicast Address Mask |
| 28 | * |
| 29 | * Parameters: |
| 30 | * In: |
Malcolm Priestley | 0ca3e28 | 2014-02-12 19:18:26 +0000 | [diff] [blame] | 31 | * mc_filter (mac filter) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 32 | * Out: |
| 33 | * none |
| 34 | * |
| 35 | * Return Value: none |
| 36 | * |
| 37 | */ |
Malcolm Priestley | d100791 | 2014-05-31 11:50:36 +0100 | [diff] [blame] | 38 | void vnt_mac_set_filter(struct vnt_private *priv, u64 mc_filter) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 39 | { |
Malcolm Priestley | 0ca3e28 | 2014-02-12 19:18:26 +0000 | [diff] [blame] | 40 | __le64 le_mc = cpu_to_le64(mc_filter); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 41 | |
Malcolm Priestley | 1390b02 | 2014-05-26 13:59:01 +0100 | [diff] [blame] | 42 | vnt_control_out(priv, MESSAGE_TYPE_WRITE, MAC_REG_MAR0, |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 43 | MESSAGE_REQUEST_MACREG, sizeof(le_mc), (u8 *)&le_mc); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 44 | } |
| 45 | |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 46 | /* |
| 47 | * Description: |
| 48 | * Shut Down MAC |
| 49 | * |
| 50 | * Parameters: |
| 51 | * In: |
| 52 | * Out: |
| 53 | * none |
| 54 | * |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 55 | * |
| 56 | */ |
Malcolm Priestley | aa6907d | 2014-05-31 11:50:37 +0100 | [diff] [blame] | 57 | void vnt_mac_shutdown(struct vnt_private *priv) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 58 | { |
Malcolm Priestley | 1390b02 | 2014-05-26 13:59:01 +0100 | [diff] [blame] | 59 | vnt_control_out(priv, MESSAGE_TYPE_MACSHUTDOWN, 0, 0, 0, NULL); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 60 | } |
| 61 | |
Malcolm Priestley | 05089fb | 2014-05-31 11:50:38 +0100 | [diff] [blame] | 62 | void vnt_mac_set_bb_type(struct vnt_private *priv, u8 type) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 63 | { |
Malcolm Priestley | bee7b68 | 2014-05-23 18:00:02 +0100 | [diff] [blame] | 64 | u8 data[2]; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 65 | |
Malcolm Priestley | bee7b68 | 2014-05-23 18:00:02 +0100 | [diff] [blame] | 66 | data[0] = type; |
| 67 | data[1] = EnCFG_BBType_MASK; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 68 | |
Malcolm Priestley | 1390b02 | 2014-05-26 13:59:01 +0100 | [diff] [blame] | 69 | vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, MAC_REG_ENCFG0, |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 70 | MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 71 | } |
| 72 | |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 73 | /* |
| 74 | * Description: |
| 75 | * Disable the Key Entry by MISCFIFO |
| 76 | * |
| 77 | * Parameters: |
| 78 | * In: |
| 79 | * dwIoBase - Base Address for MAC |
| 80 | * |
| 81 | * Out: |
| 82 | * none |
| 83 | * |
| 84 | * Return Value: none |
| 85 | * |
| 86 | */ |
Malcolm Priestley | cd73194 | 2014-05-31 11:50:39 +0100 | [diff] [blame] | 87 | void vnt_mac_disable_keyentry(struct vnt_private *priv, u8 entry_idx) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 88 | { |
Malcolm Priestley | 1390b02 | 2014-05-26 13:59:01 +0100 | [diff] [blame] | 89 | vnt_control_out(priv, MESSAGE_TYPE_CLRKEYENTRY, 0, 0, |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 90 | sizeof(entry_idx), &entry_idx); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 91 | } |
| 92 | |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 93 | /* |
| 94 | * Description: |
| 95 | * Set the Key by MISCFIFO |
| 96 | * |
| 97 | * Parameters: |
| 98 | * In: |
| 99 | * dwIoBase - Base Address for MAC |
| 100 | * |
| 101 | * Out: |
| 102 | * none |
| 103 | * |
| 104 | * Return Value: none |
| 105 | * |
| 106 | */ |
Malcolm Priestley | a7a93e3 | 2014-05-31 11:50:40 +0100 | [diff] [blame] | 107 | void vnt_mac_set_keyentry(struct vnt_private *priv, u16 key_ctl, u32 entry_idx, |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 108 | u32 key_idx, u8 *addr, u8 *key) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 109 | { |
Malcolm Priestley | 83bf96f | 2014-05-25 21:36:29 +0100 | [diff] [blame] | 110 | struct vnt_mac_set_key set_key; |
Malcolm Priestley | 39dd526 | 2014-05-26 13:58:59 +0100 | [diff] [blame] | 111 | u16 offset; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 112 | |
Malcolm Priestley | 39dd526 | 2014-05-26 13:58:59 +0100 | [diff] [blame] | 113 | offset = MISCFIFO_KEYETRY0; |
Elise Lennion | 596f144 | 2016-10-17 22:01:26 -0200 | [diff] [blame] | 114 | offset += entry_idx * MISCFIFO_KEYENTRYSIZE; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 115 | |
Malcolm Priestley | 39dd526 | 2014-05-26 13:58:59 +0100 | [diff] [blame] | 116 | set_key.u.write.key_ctl = cpu_to_le16(key_ctl); |
Aya Mahfouz | c5f9e99 | 2015-02-27 03:06:53 +0200 | [diff] [blame] | 117 | ether_addr_copy(set_key.u.write.addr, addr); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 118 | |
Malcolm Priestley | 83bf96f | 2014-05-25 21:36:29 +0100 | [diff] [blame] | 119 | /* swap over swap[0] and swap[1] to get correct write order */ |
| 120 | swap(set_key.u.swap[0], set_key.u.swap[1]); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 121 | |
Malcolm Priestley | 954e814 | 2014-05-26 13:58:58 +0100 | [diff] [blame] | 122 | memcpy(set_key.key, key, WLAN_KEY_LEN_CCMP); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 123 | |
Malcolm Priestley | 88a8926 | 2014-05-26 13:59:00 +0100 | [diff] [blame] | 124 | dev_dbg(&priv->usb->dev, "offset %d key ctl %d set key %24ph\n", |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 125 | offset, key_ctl, (u8 *)&set_key); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 126 | |
Malcolm Priestley | 1390b02 | 2014-05-26 13:59:01 +0100 | [diff] [blame] | 127 | vnt_control_out(priv, MESSAGE_TYPE_SETKEY, offset, |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 128 | (u16)key_idx, sizeof(struct vnt_mac_set_key), |
| 129 | (u8 *)&set_key); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 130 | } |
| 131 | |
Malcolm Priestley | a9bed1d | 2014-05-31 11:50:41 +0100 | [diff] [blame] | 132 | void vnt_mac_reg_bits_off(struct vnt_private *priv, u8 reg_ofs, u8 bits) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 133 | { |
Malcolm Priestley | f22f769 | 2014-05-23 18:00:05 +0100 | [diff] [blame] | 134 | u8 data[2]; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 135 | |
Malcolm Priestley | f22f769 | 2014-05-23 18:00:05 +0100 | [diff] [blame] | 136 | data[0] = 0; |
| 137 | data[1] = bits; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 138 | |
Malcolm Priestley | 1390b02 | 2014-05-26 13:59:01 +0100 | [diff] [blame] | 139 | vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 140 | reg_ofs, MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), |
| 141 | data); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 142 | } |
| 143 | |
Malcolm Priestley | 3695753 | 2014-05-31 11:50:42 +0100 | [diff] [blame] | 144 | void vnt_mac_reg_bits_on(struct vnt_private *priv, u8 reg_ofs, u8 bits) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 145 | { |
Malcolm Priestley | 8fda36c | 2014-05-23 18:00:06 +0100 | [diff] [blame] | 146 | u8 data[2]; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 147 | |
Malcolm Priestley | 8fda36c | 2014-05-23 18:00:06 +0100 | [diff] [blame] | 148 | data[0] = bits; |
| 149 | data[1] = bits; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 150 | |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 151 | vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, reg_ofs, |
| 152 | MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 153 | } |
| 154 | |
Malcolm Priestley | 57dc49a | 2014-05-31 11:50:43 +0100 | [diff] [blame] | 155 | void vnt_mac_write_word(struct vnt_private *priv, u8 reg_ofs, u16 word) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 156 | { |
Malcolm Priestley | e1cc91f | 2014-05-23 18:00:07 +0100 | [diff] [blame] | 157 | u8 data[2]; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 158 | |
Malcolm Priestley | e1cc91f | 2014-05-23 18:00:07 +0100 | [diff] [blame] | 159 | data[0] = (u8)(word & 0xff); |
| 160 | data[1] = (u8)(word >> 8); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 161 | |
Scott Matheina | cf25326 | 2017-01-10 22:34:17 -0600 | [diff] [blame] | 162 | vnt_control_out(priv, MESSAGE_TYPE_WRITE, reg_ofs, |
| 163 | MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 164 | } |
| 165 | |
Malcolm Priestley | 1cd34ea | 2014-05-31 11:50:44 +0100 | [diff] [blame] | 166 | void vnt_mac_set_bssid_addr(struct vnt_private *priv, u8 *addr) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 167 | { |
Malcolm Priestley | 1390b02 | 2014-05-26 13:59:01 +0100 | [diff] [blame] | 168 | vnt_control_out(priv, MESSAGE_TYPE_WRITE, MAC_REG_BSSID0, |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 169 | MESSAGE_REQUEST_MACREG, ETH_ALEN, addr); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 170 | } |
| 171 | |
Malcolm Priestley | ccbf441 | 2014-05-31 11:50:45 +0100 | [diff] [blame] | 172 | void vnt_mac_enable_protect_mode(struct vnt_private *priv) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 173 | { |
Malcolm Priestley | a7ecb9d | 2014-05-23 18:00:10 +0100 | [diff] [blame] | 174 | u8 data[2]; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 175 | |
Malcolm Priestley | a7ecb9d | 2014-05-23 18:00:10 +0100 | [diff] [blame] | 176 | data[0] = EnCFG_ProtectMd; |
| 177 | data[1] = EnCFG_ProtectMd; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 178 | |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 179 | vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, MAC_REG_ENCFG0, |
| 180 | MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 181 | } |
| 182 | |
Malcolm Priestley | 83a0ee4 | 2014-05-31 11:50:46 +0100 | [diff] [blame] | 183 | void vnt_mac_disable_protect_mode(struct vnt_private *priv) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 184 | { |
Malcolm Priestley | 04cc8ef | 2014-05-23 18:00:11 +0100 | [diff] [blame] | 185 | u8 data[2]; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 186 | |
Malcolm Priestley | 04cc8ef | 2014-05-23 18:00:11 +0100 | [diff] [blame] | 187 | data[0] = 0; |
| 188 | data[1] = EnCFG_ProtectMd; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 189 | |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 190 | vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, MAC_REG_ENCFG0, |
| 191 | MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 192 | } |
| 193 | |
Malcolm Priestley | a085edc | 2014-05-31 11:50:47 +0100 | [diff] [blame] | 194 | void vnt_mac_enable_barker_preamble_mode(struct vnt_private *priv) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 195 | { |
Malcolm Priestley | 23cde77 | 2014-05-23 18:00:12 +0100 | [diff] [blame] | 196 | u8 data[2]; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 197 | |
Malcolm Priestley | 23cde77 | 2014-05-23 18:00:12 +0100 | [diff] [blame] | 198 | data[0] = EnCFG_BarkerPream; |
| 199 | data[1] = EnCFG_BarkerPream; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 200 | |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 201 | vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, MAC_REG_ENCFG2, |
| 202 | MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 203 | } |
| 204 | |
Malcolm Priestley | 05827c9 | 2014-05-31 11:50:48 +0100 | [diff] [blame] | 205 | void vnt_mac_disable_barker_preamble_mode(struct vnt_private *priv) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 206 | { |
Malcolm Priestley | 67933f4 | 2014-05-23 18:00:13 +0100 | [diff] [blame] | 207 | u8 data[2]; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 208 | |
Malcolm Priestley | 67933f4 | 2014-05-23 18:00:13 +0100 | [diff] [blame] | 209 | data[0] = 0; |
| 210 | data[1] = EnCFG_BarkerPream; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 211 | |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 212 | vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, MAC_REG_ENCFG2, |
| 213 | MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 214 | } |
| 215 | |
Malcolm Priestley | 4cada36 | 2014-05-31 11:50:49 +0100 | [diff] [blame] | 216 | void vnt_mac_set_beacon_interval(struct vnt_private *priv, u16 interval) |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 217 | { |
Malcolm Priestley | ddb8c95 | 2014-05-23 18:00:14 +0100 | [diff] [blame] | 218 | u8 data[2]; |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 219 | |
Malcolm Priestley | ddb8c95 | 2014-05-23 18:00:14 +0100 | [diff] [blame] | 220 | data[0] = (u8)(interval & 0xff); |
| 221 | data[1] = (u8)(interval >> 8); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 222 | |
Scott Matheina | 0ef4891 | 2017-01-09 22:42:51 -0600 | [diff] [blame] | 223 | vnt_control_out(priv, MESSAGE_TYPE_WRITE, MAC_REG_BI, |
| 224 | MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data); |
Forest Bond | 92b9679 | 2009-06-13 07:38:31 -0400 | [diff] [blame] | 225 | } |
Malcolm Priestley | 96f6975 | 2014-05-26 13:59:04 +0100 | [diff] [blame] | 226 | |
| 227 | void vnt_mac_set_led(struct vnt_private *priv, u8 state, u8 led) |
| 228 | { |
| 229 | u8 data[2]; |
| 230 | |
| 231 | data[0] = led; |
| 232 | data[1] = state; |
| 233 | |
| 234 | vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, MAC_REG_PAPEDELAY, |
| 235 | MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data); |
Malcolm Priestley | 96f6975 | 2014-05-26 13:59:04 +0100 | [diff] [blame] | 236 | } |