forked from luck/tmp_suning_uos_patched
[PATCH] rt2x00: Remove duplicate code in MAC & BSSID handling
The various drivers contained duplicate code to handle the MAC and BSSID initialization correctly. This moves the address copy to little endian variables to rt2x00config. Signed-off-by: Ivo van Doorn <IvDoorn@gmail.com> Signed-off-by: John W. Linville <linville@tuxdriver.com>
This commit is contained in:
parent
c109810318
commit
4abee4bbd7
@ -249,32 +249,18 @@ static int rt2400pci_rfkill_poll(struct rt2x00_dev *rt2x00dev)
|
||||
/*
|
||||
* Configuration handlers.
|
||||
*/
|
||||
static void rt2400pci_config_mac_addr(struct rt2x00_dev *rt2x00dev, u8 *addr)
|
||||
static void rt2400pci_config_mac_addr(struct rt2x00_dev *rt2x00dev,
|
||||
__le32 *mac)
|
||||
{
|
||||
__le32 reg[2];
|
||||
|
||||
memset(®, 0, sizeof(reg));
|
||||
memcpy(®, addr, ETH_ALEN);
|
||||
|
||||
/*
|
||||
* The MAC address is passed to us as an array of bytes,
|
||||
* that array is little endian, so no need for byte ordering.
|
||||
*/
|
||||
rt2x00pci_register_multiwrite(rt2x00dev, CSR3, ®, sizeof(reg));
|
||||
rt2x00pci_register_multiwrite(rt2x00dev, CSR3, mac,
|
||||
(2 * sizeof(__le32)));
|
||||
}
|
||||
|
||||
static void rt2400pci_config_bssid(struct rt2x00_dev *rt2x00dev, u8 *bssid)
|
||||
static void rt2400pci_config_bssid(struct rt2x00_dev *rt2x00dev,
|
||||
__le32 *bssid)
|
||||
{
|
||||
__le32 reg[2];
|
||||
|
||||
memset(®, 0, sizeof(reg));
|
||||
memcpy(®, bssid, ETH_ALEN);
|
||||
|
||||
/*
|
||||
* The BSSID is passed to us as an array of bytes,
|
||||
* that array is little endian, so no need for byte ordering.
|
||||
*/
|
||||
rt2x00pci_register_multiwrite(rt2x00dev, CSR5, ®, sizeof(reg));
|
||||
rt2x00pci_register_multiwrite(rt2x00dev, CSR5, bssid,
|
||||
(2 * sizeof(__le32)));
|
||||
}
|
||||
|
||||
static void rt2400pci_config_type(struct rt2x00_dev *rt2x00dev, int type)
|
||||
|
@ -249,32 +249,18 @@ static int rt2500pci_rfkill_poll(struct rt2x00_dev *rt2x00dev)
|
||||
/*
|
||||
* Configuration handlers.
|
||||
*/
|
||||
static void rt2500pci_config_mac_addr(struct rt2x00_dev *rt2x00dev, u8 *addr)
|
||||
static void rt2500pci_config_mac_addr(struct rt2x00_dev *rt2x00dev,
|
||||
__le32 *mac)
|
||||
{
|
||||
__le32 reg[2];
|
||||
|
||||
memset(®, 0, sizeof(reg));
|
||||
memcpy(®, addr, ETH_ALEN);
|
||||
|
||||
/*
|
||||
* The MAC address is passed to us as an array of bytes,
|
||||
* that array is little endian, so no need for byte ordering.
|
||||
*/
|
||||
rt2x00pci_register_multiwrite(rt2x00dev, CSR3, ®, sizeof(reg));
|
||||
rt2x00pci_register_multiwrite(rt2x00dev, CSR3, mac,
|
||||
(2 * sizeof(__le32)));
|
||||
}
|
||||
|
||||
static void rt2500pci_config_bssid(struct rt2x00_dev *rt2x00dev, u8 *bssid)
|
||||
static void rt2500pci_config_bssid(struct rt2x00_dev *rt2x00dev,
|
||||
__le32 *bssid)
|
||||
{
|
||||
__le32 reg[2];
|
||||
|
||||
memset(®, 0, sizeof(reg));
|
||||
memcpy(®, bssid, ETH_ALEN);
|
||||
|
||||
/*
|
||||
* The BSSID is passed to us as an array of bytes,
|
||||
* that array is little endian, so no need for byte ordering.
|
||||
*/
|
||||
rt2x00pci_register_multiwrite(rt2x00dev, CSR5, ®, sizeof(reg));
|
||||
rt2x00pci_register_multiwrite(rt2x00dev, CSR5, bssid,
|
||||
(2 * sizeof(__le32)));
|
||||
}
|
||||
|
||||
static void rt2500pci_config_type(struct rt2x00_dev *rt2x00dev, const int type)
|
||||
|
@ -254,32 +254,18 @@ static const struct rt2x00debug rt2500usb_rt2x00debug = {
|
||||
/*
|
||||
* Configuration handlers.
|
||||
*/
|
||||
static void rt2500usb_config_mac_addr(struct rt2x00_dev *rt2x00dev, u8 *addr)
|
||||
static void rt2500usb_config_mac_addr(struct rt2x00_dev *rt2x00dev,
|
||||
__le32 *mac)
|
||||
{
|
||||
__le16 reg[3];
|
||||
|
||||
memset(®, 0, sizeof(reg));
|
||||
memcpy(®, addr, ETH_ALEN);
|
||||
|
||||
/*
|
||||
* The MAC address is passed to us as an array of bytes,
|
||||
* that array is little endian, so no need for byte ordering.
|
||||
*/
|
||||
rt2500usb_register_multiwrite(rt2x00dev, MAC_CSR2, ®, sizeof(reg));
|
||||
rt2500usb_register_multiwrite(rt2x00dev, MAC_CSR2, &mac,
|
||||
(3 * sizeof(__le16)));
|
||||
}
|
||||
|
||||
static void rt2500usb_config_bssid(struct rt2x00_dev *rt2x00dev, u8 *bssid)
|
||||
static void rt2500usb_config_bssid(struct rt2x00_dev *rt2x00dev,
|
||||
__le32 *bssid)
|
||||
{
|
||||
__le16 reg[3];
|
||||
|
||||
memset(®, 0, sizeof(reg));
|
||||
memcpy(®, bssid, ETH_ALEN);
|
||||
|
||||
/*
|
||||
* The BSSID is passed to us as an array of bytes,
|
||||
* that array is little endian, so no need for byte ordering.
|
||||
*/
|
||||
rt2500usb_register_multiwrite(rt2x00dev, MAC_CSR5, ®, sizeof(reg));
|
||||
rt2500usb_register_multiwrite(rt2x00dev, MAC_CSR5, bssid,
|
||||
(3 * sizeof(__le16)));
|
||||
}
|
||||
|
||||
static void rt2500usb_config_type(struct rt2x00_dev *rt2x00dev, const int type)
|
||||
|
@ -408,8 +408,8 @@ struct rt2x00lib_ops {
|
||||
/*
|
||||
* Configuration handlers.
|
||||
*/
|
||||
void (*config_mac_addr) (struct rt2x00_dev *rt2x00dev, u8 *mac);
|
||||
void (*config_bssid) (struct rt2x00_dev *rt2x00dev, u8 *bssid);
|
||||
void (*config_mac_addr) (struct rt2x00_dev *rt2x00dev, __le32 *mac);
|
||||
void (*config_bssid) (struct rt2x00_dev *rt2x00dev, __le32 *bssid);
|
||||
void (*config_packet_filter) (struct rt2x00_dev *rt2x00dev,
|
||||
const unsigned int filter);
|
||||
void (*config_type) (struct rt2x00_dev *rt2x00dev, const int type);
|
||||
|
@ -34,16 +34,44 @@
|
||||
#include "rt2x00.h"
|
||||
#include "rt2x00lib.h"
|
||||
|
||||
|
||||
/*
|
||||
* The MAC and BSSID addressess are simple array of bytes,
|
||||
* these arrays are little endian, so when sending the addressess
|
||||
* to the drivers, copy the it into a endian-signed variable.
|
||||
*
|
||||
* Note that all devices (except rt2500usb) have 32 bits
|
||||
* register word sizes. This means that whatever variable we
|
||||
* pass _must_ be a multiple of 32 bits. Otherwise the device
|
||||
* might not accept what we are sending to it.
|
||||
* This will also make it easier for the driver to write
|
||||
* the data to the device.
|
||||
*
|
||||
* Also note that when NULL is passed as address the
|
||||
* we will send 00:00:00:00:00 to the device to clear the address.
|
||||
* This will prevent the device being confused when it wants
|
||||
* to ACK frames or consideres itself associated.
|
||||
*/
|
||||
void rt2x00lib_config_mac_addr(struct rt2x00_dev *rt2x00dev, u8 *mac)
|
||||
{
|
||||
__le32 reg[2];
|
||||
|
||||
memset(®, 0, sizeof(reg));
|
||||
if (mac)
|
||||
rt2x00dev->ops->lib->config_mac_addr(rt2x00dev, mac);
|
||||
memcpy(®, mac, ETH_ALEN);
|
||||
|
||||
rt2x00dev->ops->lib->config_mac_addr(rt2x00dev, ®[0]);
|
||||
}
|
||||
|
||||
void rt2x00lib_config_bssid(struct rt2x00_dev *rt2x00dev, u8 *bssid)
|
||||
{
|
||||
__le32 reg[2];
|
||||
|
||||
memset(®, 0, sizeof(reg));
|
||||
if (bssid)
|
||||
rt2x00dev->ops->lib->config_bssid(rt2x00dev, bssid);
|
||||
memcpy(®, bssid, ETH_ALEN);
|
||||
|
||||
rt2x00dev->ops->lib->config_bssid(rt2x00dev, ®[0]);
|
||||
}
|
||||
|
||||
void rt2x00lib_config_type(struct rt2x00_dev *rt2x00dev, int type)
|
||||
|
@ -274,42 +274,28 @@ static int rt61pci_rfkill_poll(struct rt2x00_dev *rt2x00dev)
|
||||
/*
|
||||
* Configuration handlers.
|
||||
*/
|
||||
static void rt61pci_config_mac_addr(struct rt2x00_dev *rt2x00dev, u8 *addr)
|
||||
static void rt61pci_config_mac_addr(struct rt2x00_dev *rt2x00dev, __le32 *mac)
|
||||
{
|
||||
__le32 reg[2];
|
||||
u32 tmp;
|
||||
|
||||
memset(®, 0, sizeof(reg));
|
||||
memcpy(®, addr, ETH_ALEN);
|
||||
|
||||
tmp = le32_to_cpu(reg[1]);
|
||||
tmp = le32_to_cpu(mac[1]);
|
||||
rt2x00_set_field32(&tmp, MAC_CSR3_UNICAST_TO_ME_MASK, 0xff);
|
||||
reg[1] = cpu_to_le32(tmp);
|
||||
mac[1] = cpu_to_le32(tmp);
|
||||
|
||||
/*
|
||||
* The MAC address is passed to us as an array of bytes,
|
||||
* that array is little endian, so no need for byte ordering.
|
||||
*/
|
||||
rt2x00pci_register_multiwrite(rt2x00dev, MAC_CSR2, ®, sizeof(reg));
|
||||
rt2x00pci_register_multiwrite(rt2x00dev, MAC_CSR2, mac,
|
||||
(2 * sizeof(__le32)));
|
||||
}
|
||||
|
||||
static void rt61pci_config_bssid(struct rt2x00_dev *rt2x00dev, u8 *bssid)
|
||||
static void rt61pci_config_bssid(struct rt2x00_dev *rt2x00dev, __le32 *bssid)
|
||||
{
|
||||
__le32 reg[2];
|
||||
u32 tmp;
|
||||
|
||||
memset(®, 0, sizeof(reg));
|
||||
memcpy(®, bssid, ETH_ALEN);
|
||||
|
||||
tmp = le32_to_cpu(reg[1]);
|
||||
tmp = le32_to_cpu(bssid[1]);
|
||||
rt2x00_set_field32(&tmp, MAC_CSR5_BSS_ID_MASK, 3);
|
||||
reg[1] = cpu_to_le32(tmp);
|
||||
bssid[1] = cpu_to_le32(tmp);
|
||||
|
||||
/*
|
||||
* The BSSID is passed to us as an array of bytes,
|
||||
* that array is little endian, so no need for byte ordering.
|
||||
*/
|
||||
rt2x00pci_register_multiwrite(rt2x00dev, MAC_CSR4, ®, sizeof(reg));
|
||||
rt2x00pci_register_multiwrite(rt2x00dev, MAC_CSR4, bssid,
|
||||
(2 * sizeof(__le32)));
|
||||
}
|
||||
|
||||
static void rt61pci_config_type(struct rt2x00_dev *rt2x00dev, const int type)
|
||||
|
@ -255,42 +255,28 @@ static const struct rt2x00debug rt73usb_rt2x00debug = {
|
||||
/*
|
||||
* Configuration handlers.
|
||||
*/
|
||||
static void rt73usb_config_mac_addr(struct rt2x00_dev *rt2x00dev, u8 *addr)
|
||||
static void rt73usb_config_mac_addr(struct rt2x00_dev *rt2x00dev, __le32 *mac)
|
||||
{
|
||||
__le32 reg[2];
|
||||
u32 tmp;
|
||||
|
||||
memset(®, 0, sizeof(reg));
|
||||
memcpy(®, addr, ETH_ALEN);
|
||||
|
||||
tmp = le32_to_cpu(reg[1]);
|
||||
tmp = le32_to_cpu(mac[1]);
|
||||
rt2x00_set_field32(&tmp, MAC_CSR3_UNICAST_TO_ME_MASK, 0xff);
|
||||
reg[1] = cpu_to_le32(tmp);
|
||||
mac[1] = cpu_to_le32(tmp);
|
||||
|
||||
/*
|
||||
* The MAC address is passed to us as an array of bytes,
|
||||
* that array is little endian, so no need for byte ordering.
|
||||
*/
|
||||
rt73usb_register_multiwrite(rt2x00dev, MAC_CSR2, ®, sizeof(reg));
|
||||
rt73usb_register_multiwrite(rt2x00dev, MAC_CSR2, mac,
|
||||
(2 * sizeof(__le32)));
|
||||
}
|
||||
|
||||
static void rt73usb_config_bssid(struct rt2x00_dev *rt2x00dev, u8 *bssid)
|
||||
static void rt73usb_config_bssid(struct rt2x00_dev *rt2x00dev, __le32 *bssid)
|
||||
{
|
||||
__le32 reg[2];
|
||||
u32 tmp;
|
||||
|
||||
memset(®, 0, sizeof(reg));
|
||||
memcpy(®, bssid, ETH_ALEN);
|
||||
|
||||
tmp = le32_to_cpu(reg[1]);
|
||||
tmp = le32_to_cpu(bssid[1]);
|
||||
rt2x00_set_field32(&tmp, MAC_CSR5_BSS_ID_MASK, 3);
|
||||
reg[1] = cpu_to_le32(tmp);
|
||||
bssid[1] = cpu_to_le32(tmp);
|
||||
|
||||
/*
|
||||
* The BSSID is passed to us as an array of bytes,
|
||||
* that array is little endian, so no need for byte ordering.
|
||||
*/
|
||||
rt73usb_register_multiwrite(rt2x00dev, MAC_CSR4, ®, sizeof(reg));
|
||||
rt73usb_register_multiwrite(rt2x00dev, MAC_CSR4, bssid,
|
||||
(2 * sizeof(__le32)));
|
||||
}
|
||||
|
||||
static void rt73usb_config_type(struct rt2x00_dev *rt2x00dev, const int type)
|
||||
|
Loading…
Reference in New Issue
Block a user