2017-11-07 20:07:52 +00:00
|
|
|
// SPDX-License-Identifier: GPL-2.0+
|
2009-06-13 11:38:31 +00:00
|
|
|
/*
|
|
|
|
* Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
|
|
|
|
* All rights reserved.
|
|
|
|
*
|
|
|
|
* File: mac.c
|
|
|
|
*
|
|
|
|
* Purpose: MAC routines
|
|
|
|
*
|
|
|
|
* Author: Tevin Chen
|
|
|
|
*
|
|
|
|
* Date: May 21, 1996
|
|
|
|
*
|
|
|
|
* Functions:
|
|
|
|
*
|
|
|
|
* Revision History:
|
|
|
|
*/
|
|
|
|
|
2015-02-27 01:06:53 +00:00
|
|
|
#include <linux/etherdevice.h>
|
|
|
|
|
2009-06-13 11:38:31 +00:00
|
|
|
#include "desc.h"
|
|
|
|
#include "mac.h"
|
2014-05-26 12:59:07 +00:00
|
|
|
#include "usbpipe.h"
|
2009-08-12 21:54:08 +00:00
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
int vnt_mac_set_filter(struct vnt_private *priv, u64 mc_filter)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2014-02-12 19:18:26 +00:00
|
|
|
__le64 le_mc = cpu_to_le64(mc_filter);
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE, MAC_REG_MAR0,
|
|
|
|
MESSAGE_REQUEST_MACREG, sizeof(le_mc),
|
|
|
|
(u8 *)&le_mc);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
int vnt_mac_shutdown(struct vnt_private *priv)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2020-04-25 13:42:56 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_MACSHUTDOWN, 0, 0, 0, NULL);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
int vnt_mac_set_bb_type(struct vnt_private *priv, u8 type)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2014-05-23 17:00:02 +00:00
|
|
|
u8 data[2];
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2014-05-23 17:00:02 +00:00
|
|
|
data[0] = type;
|
|
|
|
data[1] = EnCFG_BBType_MASK;
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, MAC_REG_ENCFG0,
|
|
|
|
MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data),
|
|
|
|
data);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
int vnt_mac_disable_keyentry(struct vnt_private *priv, u8 entry_idx)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2020-04-25 13:42:56 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_CLRKEYENTRY, 0, 0,
|
|
|
|
sizeof(entry_idx), &entry_idx);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
int vnt_mac_set_keyentry(struct vnt_private *priv, u16 key_ctl, u32 entry_idx,
|
|
|
|
u32 key_idx, u8 *addr, u8 *key)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2014-05-25 20:36:29 +00:00
|
|
|
struct vnt_mac_set_key set_key;
|
2014-05-26 12:58:59 +00:00
|
|
|
u16 offset;
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2014-05-26 12:58:59 +00:00
|
|
|
offset = MISCFIFO_KEYETRY0;
|
2016-10-18 00:01:26 +00:00
|
|
|
offset += entry_idx * MISCFIFO_KEYENTRYSIZE;
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2014-05-26 12:58:59 +00:00
|
|
|
set_key.u.write.key_ctl = cpu_to_le16(key_ctl);
|
2015-02-27 01:06:53 +00:00
|
|
|
ether_addr_copy(set_key.u.write.addr, addr);
|
2014-05-25 20:36:29 +00:00
|
|
|
|
|
|
|
/* swap over swap[0] and swap[1] to get correct write order */
|
|
|
|
swap(set_key.u.swap[0], set_key.u.swap[1]);
|
|
|
|
|
2014-05-26 12:58:58 +00:00
|
|
|
memcpy(set_key.key, key, WLAN_KEY_LEN_CCMP);
|
2014-05-25 20:36:29 +00:00
|
|
|
|
2014-05-26 12:59:00 +00:00
|
|
|
dev_dbg(&priv->usb->dev, "offset %d key ctl %d set key %24ph\n",
|
2017-01-10 04:42:51 +00:00
|
|
|
offset, key_ctl, (u8 *)&set_key);
|
2014-05-25 20:36:29 +00:00
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_SETKEY, offset,
|
|
|
|
(u16)key_idx, sizeof(struct vnt_mac_set_key),
|
|
|
|
(u8 *)&set_key);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2019-05-20 16:39:02 +00:00
|
|
|
int vnt_mac_reg_bits_off(struct vnt_private *priv, u8 reg_ofs, u8 bits)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2014-05-23 17:00:05 +00:00
|
|
|
u8 data[2];
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2014-05-23 17:00:05 +00:00
|
|
|
data[0] = 0;
|
|
|
|
data[1] = bits;
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2019-05-20 16:39:02 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, reg_ofs,
|
|
|
|
MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2019-05-20 16:39:02 +00:00
|
|
|
int vnt_mac_reg_bits_on(struct vnt_private *priv, u8 reg_ofs, u8 bits)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2014-05-23 17:00:06 +00:00
|
|
|
u8 data[2];
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2014-05-23 17:00:06 +00:00
|
|
|
data[0] = bits;
|
|
|
|
data[1] = bits;
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2019-05-20 16:39:02 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, reg_ofs,
|
|
|
|
MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
int vnt_mac_write_word(struct vnt_private *priv, u8 reg_ofs, u16 word)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2014-05-23 17:00:07 +00:00
|
|
|
u8 data[2];
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2014-05-23 17:00:07 +00:00
|
|
|
data[0] = (u8)(word & 0xff);
|
|
|
|
data[1] = (u8)(word >> 8);
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE, reg_ofs,
|
|
|
|
MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
int vnt_mac_set_bssid_addr(struct vnt_private *priv, u8 *addr)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2020-04-25 13:42:56 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE, MAC_REG_BSSID0,
|
|
|
|
MESSAGE_REQUEST_MACREG, ETH_ALEN, addr);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
int vnt_mac_enable_protect_mode(struct vnt_private *priv)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2014-05-23 17:00:10 +00:00
|
|
|
u8 data[2];
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2014-05-23 17:00:10 +00:00
|
|
|
data[0] = EnCFG_ProtectMd;
|
|
|
|
data[1] = EnCFG_ProtectMd;
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, MAC_REG_ENCFG0,
|
|
|
|
MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
int vnt_mac_disable_protect_mode(struct vnt_private *priv)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2014-05-23 17:00:11 +00:00
|
|
|
u8 data[2];
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2014-05-23 17:00:11 +00:00
|
|
|
data[0] = 0;
|
|
|
|
data[1] = EnCFG_ProtectMd;
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, MAC_REG_ENCFG0,
|
|
|
|
MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
int vnt_mac_enable_barker_preamble_mode(struct vnt_private *priv)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2014-05-23 17:00:12 +00:00
|
|
|
u8 data[2];
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2014-05-23 17:00:12 +00:00
|
|
|
data[0] = EnCFG_BarkerPream;
|
|
|
|
data[1] = EnCFG_BarkerPream;
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, MAC_REG_ENCFG2,
|
|
|
|
MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
int vnt_mac_disable_barker_preamble_mode(struct vnt_private *priv)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2014-05-23 17:00:13 +00:00
|
|
|
u8 data[2];
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2014-05-23 17:00:13 +00:00
|
|
|
data[0] = 0;
|
|
|
|
data[1] = EnCFG_BarkerPream;
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, MAC_REG_ENCFG2,
|
|
|
|
MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
int vnt_mac_set_beacon_interval(struct vnt_private *priv, u16 interval)
|
2009-06-13 11:38:31 +00:00
|
|
|
{
|
2014-05-23 17:00:14 +00:00
|
|
|
u8 data[2];
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2014-05-23 17:00:14 +00:00
|
|
|
data[0] = (u8)(interval & 0xff);
|
|
|
|
data[1] = (u8)(interval >> 8);
|
2009-06-13 11:38:31 +00:00
|
|
|
|
2020-04-25 13:42:56 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE, MAC_REG_BI,
|
|
|
|
MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data);
|
2009-06-13 11:38:31 +00:00
|
|
|
}
|
2014-05-26 12:59:04 +00:00
|
|
|
|
2019-05-20 16:39:02 +00:00
|
|
|
int vnt_mac_set_led(struct vnt_private *priv, u8 state, u8 led)
|
2014-05-26 12:59:04 +00:00
|
|
|
{
|
|
|
|
u8 data[2];
|
|
|
|
|
|
|
|
data[0] = led;
|
|
|
|
data[1] = state;
|
|
|
|
|
2019-05-20 16:39:02 +00:00
|
|
|
return vnt_control_out(priv, MESSAGE_TYPE_WRITE_MASK, MAC_REG_PAPEDELAY,
|
|
|
|
MESSAGE_REQUEST_MACREG, ARRAY_SIZE(data), data);
|
2014-05-26 12:59:04 +00:00
|
|
|
}
|