mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-26 22:24:09 +08:00
staging: vt6655: mac80211 conversion add main mac80211 functions
Replace existing vt6655_probe with one converted to mac80211 with the following operations vnt_tx_80211 vnt_start vnt_stop vnt_add_interface vnt_remove_interface vnt_config vnt_bss_info_changed vnt_prepare_multicast vnt_configure vnt_set_key vnt_get_tsf vnt_set_tsf vnt_reset_tsf The following variables are also added. basic_rates mc_list_count mac_hw Signed-off-by: Malcolm Priestley <tvboxspy@gmail.com> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
Malcolm Priestley
Greg Kroah-Hartman
parent
89cf9be6e6
commit
67013f2c0e
@ -324,7 +324,10 @@ struct vnt_private {
|
||||
struct ieee80211_hw *hw;
|
||||
struct ieee80211_vif *vif;
|
||||
unsigned long key_entry_inuse;
|
||||
u32 basic_rates;
|
||||
u16 current_aid;
|
||||
int mc_list_count;
|
||||
u8 mac_hw;
|
||||
/* netdev */
|
||||
struct net_device *dev;
|
||||
|
||||
|
||||
@ -809,142 +809,6 @@ static const struct net_device_ops device_netdev_ops = {
|
||||
.ndo_set_rx_mode = device_set_multi,
|
||||
};
|
||||
|
||||
static int
|
||||
vt6655_probe(struct pci_dev *pcid, const struct pci_device_id *ent)
|
||||
{
|
||||
static bool bFirst = true;
|
||||
struct net_device *dev = NULL;
|
||||
PCHIP_INFO pChip_info = (PCHIP_INFO)ent->driver_data;
|
||||
struct vnt_private *pDevice;
|
||||
int rc;
|
||||
|
||||
dev = alloc_etherdev(sizeof(*pDevice));
|
||||
|
||||
pDevice = netdev_priv(dev);
|
||||
|
||||
if (dev == NULL) {
|
||||
pr_err(DEVICE_NAME ": allocate net device failed\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
// Chain it all together
|
||||
SET_NETDEV_DEV(dev, &pcid->dev);
|
||||
|
||||
if (bFirst) {
|
||||
pr_notice("%s Ver. %s\n", DEVICE_FULL_DRV_NAM, DEVICE_VERSION);
|
||||
pr_notice("Copyright (c) 2003 VIA Networking Technologies, Inc.\n");
|
||||
bFirst = false;
|
||||
}
|
||||
|
||||
vt6655_init_info(pcid, &pDevice, pChip_info);
|
||||
pDevice->dev = dev;
|
||||
|
||||
if (pci_enable_device(pcid)) {
|
||||
device_free_info(pDevice);
|
||||
return -ENODEV;
|
||||
}
|
||||
dev->irq = pcid->irq;
|
||||
|
||||
#ifdef DEBUG
|
||||
pr_debug("Before get pci_info memaddr is %x\n", pDevice->memaddr);
|
||||
#endif
|
||||
if (!device_get_pci_info(pDevice, pcid)) {
|
||||
pr_err(DEVICE_NAME ": Failed to find PCI device.\n");
|
||||
device_free_info(pDevice);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
#ifdef DEBUG
|
||||
|
||||
pr_debug("after get pci_info memaddr is %x, io addr is %x,io_size is %d\n", pDevice->memaddr, pDevice->ioaddr, pDevice->io_size);
|
||||
{
|
||||
int i;
|
||||
u32 bar, len;
|
||||
u32 address[] = {
|
||||
PCI_BASE_ADDRESS_0,
|
||||
PCI_BASE_ADDRESS_1,
|
||||
PCI_BASE_ADDRESS_2,
|
||||
PCI_BASE_ADDRESS_3,
|
||||
PCI_BASE_ADDRESS_4,
|
||||
PCI_BASE_ADDRESS_5,
|
||||
0};
|
||||
for (i = 0; address[i]; i++) {
|
||||
pci_read_config_dword(pcid, address[i], &bar);
|
||||
pr_debug("bar %d is %x\n", i, bar);
|
||||
if (!bar) {
|
||||
pr_debug("bar %d not implemented\n", i);
|
||||
continue;
|
||||
}
|
||||
if (bar & PCI_BASE_ADDRESS_SPACE_IO) {
|
||||
/* This is IO */
|
||||
|
||||
len = bar & (PCI_BASE_ADDRESS_IO_MASK & 0xFFFF);
|
||||
len = len & ~(len - 1);
|
||||
|
||||
pr_debug("IO space: len in IO %x, BAR %d\n", len, i);
|
||||
} else {
|
||||
len = bar & 0xFFFFFFF0;
|
||||
len = ~len + 1;
|
||||
|
||||
pr_debug("len in MEM %x, BAR %d\n", len, i);
|
||||
}
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
pDevice->PortOffset = ioremap(pDevice->memaddr & PCI_BASE_ADDRESS_MEM_MASK, pDevice->io_size);
|
||||
|
||||
if (pDevice->PortOffset == NULL) {
|
||||
pr_err(DEVICE_NAME ": Failed to IO remapping ..\n");
|
||||
device_free_info(pDevice);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
rc = pci_request_regions(pcid, DEVICE_NAME);
|
||||
if (rc) {
|
||||
pr_err(DEVICE_NAME ": Failed to find PCI device\n");
|
||||
device_free_info(pDevice);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
dev->base_addr = pDevice->ioaddr;
|
||||
// do reset
|
||||
if (!MACbSoftwareReset(pDevice->PortOffset)) {
|
||||
pr_err(DEVICE_NAME ": Failed to access MAC hardware..\n");
|
||||
device_free_info(pDevice);
|
||||
return -ENODEV;
|
||||
}
|
||||
// initial to reload eeprom
|
||||
MACvInitialize(pDevice->PortOffset);
|
||||
MACvReadEtherAddress(pDevice->PortOffset, dev->dev_addr);
|
||||
|
||||
device_get_options(pDevice);
|
||||
device_set_options(pDevice);
|
||||
//Mask out the options cannot be set to the chip
|
||||
pDevice->sOpts.flags &= pChip_info->flags;
|
||||
|
||||
//Enable the chip specified capabilities
|
||||
pDevice->flags = pDevice->sOpts.flags | (pChip_info->flags & 0xFF000000UL);
|
||||
pDevice->tx_80211 = device_dma0_tx_80211;
|
||||
pDevice->sMgmtObj.pAdapter = (void *)pDevice;
|
||||
pDevice->pMgmt = &(pDevice->sMgmtObj);
|
||||
|
||||
dev->irq = pcid->irq;
|
||||
dev->netdev_ops = &device_netdev_ops;
|
||||
|
||||
dev->wireless_handlers = &iwctl_handler_def;
|
||||
|
||||
rc = register_netdev(dev);
|
||||
if (rc) {
|
||||
pr_err(DEVICE_NAME " Failed to register netdev\n");
|
||||
device_free_info(pDevice);
|
||||
return -ENODEV;
|
||||
}
|
||||
device_print_info(pDevice);
|
||||
pci_set_drvdata(pcid, pDevice);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void device_print_info(struct vnt_private *pDevice)
|
||||
{
|
||||
struct net_device *dev = pDevice->dev;
|
||||
@ -2996,6 +2860,624 @@ static int ethtool_ioctl(struct net_device *dev, void __user *useraddr)
|
||||
return -EOPNOTSUPP;
|
||||
}
|
||||
|
||||
static int vnt_tx_packet(struct vnt_private *priv, struct sk_buff *skb)
|
||||
{
|
||||
struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
|
||||
PSTxDesc head_td;
|
||||
u32 dma_idx = TYPE_AC0DMA;
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&priv->lock, flags);
|
||||
|
||||
if (!ieee80211_is_data(hdr->frame_control))
|
||||
dma_idx = TYPE_TXDMA0;
|
||||
|
||||
if (AVAIL_TD(priv, dma_idx) < 1) {
|
||||
spin_unlock_irqrestore(&priv->lock, flags);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
head_td = priv->apCurrTD[dma_idx];
|
||||
|
||||
head_td->m_td1TD1.byTCR = (TCR_EDP|TCR_STP);
|
||||
|
||||
head_td->pTDInfo->skb = skb;
|
||||
|
||||
priv->iTDUsed[dma_idx]++;
|
||||
|
||||
/* Take ownership */
|
||||
wmb();
|
||||
head_td->m_td0TD0.f1Owner = OWNED_BY_NIC;
|
||||
|
||||
/* get Next */
|
||||
wmb();
|
||||
priv->apCurrTD[dma_idx] = head_td->next;
|
||||
|
||||
spin_unlock_irqrestore(&priv->lock, flags);
|
||||
|
||||
vnt_generate_fifo_header(priv, dma_idx, head_td, skb);
|
||||
|
||||
if (MACbIsRegBitsOn(priv->PortOffset, MAC_REG_PSCTL, PSCTL_PS))
|
||||
MACbPSWakeup(priv->PortOffset);
|
||||
|
||||
spin_lock_irqsave(&priv->lock, flags);
|
||||
|
||||
priv->bPWBitOn = false;
|
||||
|
||||
head_td->pTDInfo->byFlags = TD_FLAGS_NETIF_SKB;
|
||||
|
||||
if (dma_idx == TYPE_AC0DMA)
|
||||
MACvTransmitAC0(priv->PortOffset);
|
||||
else
|
||||
MACvTransmit0(priv->PortOffset);
|
||||
|
||||
spin_unlock_irqrestore(&priv->lock, flags);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void vnt_tx_80211(struct ieee80211_hw *hw,
|
||||
struct ieee80211_tx_control *control,
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
|
||||
ieee80211_stop_queues(hw);
|
||||
|
||||
if (vnt_tx_packet(priv, skb)) {
|
||||
ieee80211_free_txskb(hw, skb);
|
||||
|
||||
ieee80211_wake_queues(hw);
|
||||
}
|
||||
}
|
||||
|
||||
static int vnt_start(struct ieee80211_hw *hw)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
int ret;
|
||||
|
||||
priv->rx_buf_sz = PKT_BUF_SZ;
|
||||
if (!device_init_rings(priv))
|
||||
return -ENOMEM;
|
||||
|
||||
ret = request_irq(priv->pcid->irq, &device_intr,
|
||||
IRQF_SHARED, "vt6655", priv);
|
||||
if (ret) {
|
||||
dev_dbg(&priv->pcid->dev, "failed to start irq\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
dev_dbg(&priv->pcid->dev, "call device init rd0 ring\n");
|
||||
device_init_rd0_ring(priv);
|
||||
device_init_rd1_ring(priv);
|
||||
device_init_defrag_cb(priv);
|
||||
device_init_td0_ring(priv);
|
||||
device_init_td1_ring(priv);
|
||||
|
||||
device_init_registers(priv);
|
||||
|
||||
dev_dbg(&priv->pcid->dev, "call MACvIntEnable\n");
|
||||
MACvIntEnable(priv->PortOffset, IMR_MASK_VALUE);
|
||||
|
||||
ieee80211_wake_queues(hw);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void vnt_stop(struct ieee80211_hw *hw)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
|
||||
ieee80211_stop_queues(hw);
|
||||
|
||||
MACbShutdown(priv->PortOffset);
|
||||
MACbSoftwareReset(priv->PortOffset);
|
||||
CARDbRadioPowerOff(priv);
|
||||
|
||||
device_free_td0_ring(priv);
|
||||
device_free_td1_ring(priv);
|
||||
device_free_rd0_ring(priv);
|
||||
device_free_rd1_ring(priv);
|
||||
device_free_frag_buf(priv);
|
||||
device_free_rings(priv);
|
||||
|
||||
free_irq(priv->pcid->irq, priv);
|
||||
}
|
||||
|
||||
static int vnt_add_interface(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
|
||||
priv->vif = vif;
|
||||
|
||||
switch (vif->type) {
|
||||
case NL80211_IFTYPE_STATION:
|
||||
if (priv->bDiversityRegCtlON)
|
||||
device_init_diversity_timer(priv);
|
||||
break;
|
||||
case NL80211_IFTYPE_ADHOC:
|
||||
MACvRegBitsOff(priv->PortOffset, MAC_REG_RCR, RCR_UNICAST);
|
||||
|
||||
MACvRegBitsOn(priv->PortOffset, MAC_REG_HOSTCR, HOSTCR_ADHOC);
|
||||
|
||||
break;
|
||||
case NL80211_IFTYPE_AP:
|
||||
MACvRegBitsOff(priv->PortOffset, MAC_REG_RCR, RCR_UNICAST);
|
||||
|
||||
MACvRegBitsOn(priv->PortOffset, MAC_REG_HOSTCR, HOSTCR_AP);
|
||||
|
||||
break;
|
||||
default:
|
||||
return -EOPNOTSUPP;
|
||||
}
|
||||
|
||||
priv->op_mode = vif->type;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void vnt_remove_interface(struct ieee80211_hw *hw,
|
||||
struct ieee80211_vif *vif)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
|
||||
switch (vif->type) {
|
||||
case NL80211_IFTYPE_STATION:
|
||||
if (priv->bDiversityRegCtlON) {
|
||||
del_timer(&priv->TimerSQ3Tmax1);
|
||||
del_timer(&priv->TimerSQ3Tmax2);
|
||||
del_timer(&priv->TimerSQ3Tmax3);
|
||||
}
|
||||
break;
|
||||
case NL80211_IFTYPE_ADHOC:
|
||||
MACvRegBitsOff(priv->PortOffset, MAC_REG_TCR, TCR_AUTOBCNTX);
|
||||
MACvRegBitsOff(priv->PortOffset,
|
||||
MAC_REG_TFTCTL, TFTCTL_TSFCNTREN);
|
||||
MACvRegBitsOff(priv->PortOffset, MAC_REG_HOSTCR, HOSTCR_ADHOC);
|
||||
break;
|
||||
case NL80211_IFTYPE_AP:
|
||||
MACvRegBitsOff(priv->PortOffset, MAC_REG_TCR, TCR_AUTOBCNTX);
|
||||
MACvRegBitsOff(priv->PortOffset,
|
||||
MAC_REG_TFTCTL, TFTCTL_TSFCNTREN);
|
||||
MACvRegBitsOff(priv->PortOffset, MAC_REG_HOSTCR, HOSTCR_AP);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
priv->op_mode = NL80211_IFTYPE_UNSPECIFIED;
|
||||
}
|
||||
|
||||
|
||||
static int vnt_config(struct ieee80211_hw *hw, u32 changed)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
struct ieee80211_conf *conf = &hw->conf;
|
||||
u8 bb_type;
|
||||
|
||||
if (changed & IEEE80211_CONF_CHANGE_PS) {
|
||||
if (conf->flags & IEEE80211_CONF_PS)
|
||||
PSvEnablePowerSaving(priv, conf->listen_interval);
|
||||
else
|
||||
PSvDisablePowerSaving(priv);
|
||||
}
|
||||
|
||||
if ((changed & IEEE80211_CONF_CHANGE_CHANNEL) ||
|
||||
(conf->flags & IEEE80211_CONF_OFFCHANNEL)) {
|
||||
set_channel(priv, conf->chandef.chan->hw_value);
|
||||
|
||||
if (conf->chandef.chan->band == IEEE80211_BAND_5GHZ)
|
||||
bb_type = BB_TYPE_11A;
|
||||
else
|
||||
bb_type = BB_TYPE_11G;
|
||||
|
||||
if (priv->byBBType != bb_type) {
|
||||
priv->byBBType = bb_type;
|
||||
|
||||
CARDbSetPhyParameter(priv,
|
||||
priv->byBBType, 0, 0, NULL, NULL);
|
||||
}
|
||||
}
|
||||
|
||||
if (changed & IEEE80211_CONF_CHANGE_POWER) {
|
||||
if (priv->byBBType == BB_TYPE_11B)
|
||||
priv->wCurrentRate = RATE_1M;
|
||||
else
|
||||
priv->wCurrentRate = RATE_54M;
|
||||
|
||||
RFbSetPower(priv, priv->wCurrentRate,
|
||||
conf->chandef.chan->hw_value);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void vnt_bss_info_changed(struct ieee80211_hw *hw,
|
||||
struct ieee80211_vif *vif, struct ieee80211_bss_conf *conf,
|
||||
u32 changed)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
|
||||
priv->current_aid = conf->aid;
|
||||
|
||||
if (changed & BSS_CHANGED_BSSID)
|
||||
MACvWriteBSSIDAddress(priv->PortOffset, (u8 *)conf->bssid);
|
||||
|
||||
if (changed & BSS_CHANGED_BASIC_RATES) {
|
||||
priv->basic_rates = conf->basic_rates;
|
||||
|
||||
CARDvUpdateBasicTopRate(priv);
|
||||
|
||||
dev_dbg(&priv->pcid->dev,
|
||||
"basic rates %x\n", conf->basic_rates);
|
||||
}
|
||||
|
||||
if (changed & BSS_CHANGED_ERP_PREAMBLE) {
|
||||
if (conf->use_short_preamble) {
|
||||
MACvEnableBarkerPreambleMd(priv->PortOffset);
|
||||
priv->byPreambleType = true;
|
||||
} else {
|
||||
MACvDisableBarkerPreambleMd(priv->PortOffset);
|
||||
priv->byPreambleType = false;
|
||||
}
|
||||
}
|
||||
|
||||
if (changed & BSS_CHANGED_ERP_CTS_PROT) {
|
||||
if (conf->use_cts_prot)
|
||||
MACvEnableProtectMD(priv->PortOffset);
|
||||
else
|
||||
MACvDisableProtectMD(priv->PortOffset);
|
||||
}
|
||||
|
||||
if (changed & BSS_CHANGED_ERP_SLOT) {
|
||||
if (conf->use_short_slot)
|
||||
priv->bShortSlotTime = true;
|
||||
else
|
||||
priv->bShortSlotTime = false;
|
||||
|
||||
vUpdateIFS(priv);
|
||||
CARDbSetPhyParameter(priv, priv->byBBType, 0, 0, NULL, NULL);
|
||||
BBvSetVGAGainOffset(priv, priv->abyBBVGA[0]);
|
||||
}
|
||||
|
||||
if (changed & BSS_CHANGED_TXPOWER)
|
||||
RFbSetPower(priv, priv->wCurrentRate,
|
||||
conf->chandef.chan->hw_value);
|
||||
|
||||
if (changed & BSS_CHANGED_BEACON_ENABLED) {
|
||||
dev_dbg(&priv->pcid->dev,
|
||||
"Beacon enable %d\n", conf->enable_beacon);
|
||||
|
||||
if (conf->enable_beacon) {
|
||||
vnt_beacon_enable(priv, vif, conf);
|
||||
|
||||
MACvRegBitsOn(priv, MAC_REG_TCR, TCR_AUTOBCNTX);
|
||||
} else {
|
||||
MACvRegBitsOff(priv, MAC_REG_TCR, TCR_AUTOBCNTX);
|
||||
}
|
||||
}
|
||||
|
||||
if (changed & BSS_CHANGED_ASSOC && priv->op_mode != NL80211_IFTYPE_AP) {
|
||||
if (conf->assoc) {
|
||||
CARDbUpdateTSF(priv, conf->beacon_rate->hw_value,
|
||||
conf->sync_device_ts, conf->sync_tsf);
|
||||
|
||||
CARDbSetBeaconPeriod(priv, conf->beacon_int);
|
||||
|
||||
CARDvSetFirstNextTBTT(priv->PortOffset,
|
||||
conf->beacon_int);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
static u64 vnt_prepare_multicast(struct ieee80211_hw *hw,
|
||||
struct netdev_hw_addr_list *mc_list)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
struct netdev_hw_addr *ha;
|
||||
u64 mc_filter = 0;
|
||||
u32 bit_nr = 0;
|
||||
|
||||
netdev_hw_addr_list_for_each(ha, mc_list) {
|
||||
bit_nr = ether_crc(ETH_ALEN, ha->addr) >> 26;
|
||||
|
||||
mc_filter |= 1ULL << (bit_nr & 0x3f);
|
||||
}
|
||||
|
||||
priv->mc_list_count = mc_list->count;
|
||||
|
||||
return mc_filter;
|
||||
}
|
||||
|
||||
static void vnt_configure(struct ieee80211_hw *hw,
|
||||
unsigned int changed_flags, unsigned int *total_flags, u64 multicast)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
u8 rx_mode = 0;
|
||||
|
||||
*total_flags &= FIF_ALLMULTI | FIF_OTHER_BSS | FIF_PROMISC_IN_BSS |
|
||||
FIF_BCN_PRBRESP_PROMISC;
|
||||
|
||||
VNSvInPortB(priv->PortOffset + MAC_REG_RCR, &rx_mode);
|
||||
|
||||
dev_dbg(&priv->pcid->dev, "rx mode in = %x\n", rx_mode);
|
||||
|
||||
if (changed_flags & FIF_PROMISC_IN_BSS) {
|
||||
/* unconditionally log net taps */
|
||||
if (*total_flags & FIF_PROMISC_IN_BSS)
|
||||
rx_mode |= RCR_UNICAST;
|
||||
else
|
||||
rx_mode &= ~RCR_UNICAST;
|
||||
}
|
||||
|
||||
if (changed_flags & FIF_ALLMULTI) {
|
||||
if (*total_flags & FIF_ALLMULTI) {
|
||||
if (priv->mc_list_count > 2) {
|
||||
MACvSelectPage1(priv->PortOffset);
|
||||
|
||||
VNSvOutPortD(priv->PortOffset +
|
||||
MAC_REG_MAR0, 0xffffffff);
|
||||
VNSvOutPortD(priv->PortOffset +
|
||||
MAC_REG_MAR0 + 4, 0xffffffff);
|
||||
|
||||
MACvSelectPage0(priv->PortOffset);
|
||||
} else {
|
||||
MACvSelectPage1(priv->PortOffset);
|
||||
|
||||
VNSvOutPortD(priv->PortOffset +
|
||||
MAC_REG_MAR0, (u32)multicast);
|
||||
VNSvOutPortD(priv->PortOffset +
|
||||
MAC_REG_MAR0 + 4,
|
||||
(u32)(multicast >> 32));
|
||||
|
||||
MACvSelectPage0(priv->PortOffset);
|
||||
}
|
||||
|
||||
rx_mode |= RCR_MULTICAST | RCR_BROADCAST;
|
||||
} else {
|
||||
rx_mode &= ~(RCR_MULTICAST | RCR_BROADCAST);
|
||||
}
|
||||
}
|
||||
|
||||
if (changed_flags & (FIF_OTHER_BSS | FIF_BCN_PRBRESP_PROMISC)) {
|
||||
rx_mode |= RCR_MULTICAST | RCR_BROADCAST;
|
||||
|
||||
if (*total_flags & (FIF_OTHER_BSS | FIF_BCN_PRBRESP_PROMISC))
|
||||
rx_mode &= ~RCR_BSSID;
|
||||
else
|
||||
rx_mode |= RCR_BSSID;
|
||||
}
|
||||
|
||||
VNSvOutPortB(priv->PortOffset + MAC_REG_RCR, rx_mode);
|
||||
|
||||
dev_dbg(&priv->pcid->dev, "rx mode out= %x\n", rx_mode);
|
||||
}
|
||||
|
||||
static int vnt_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
|
||||
struct ieee80211_vif *vif, struct ieee80211_sta *sta,
|
||||
struct ieee80211_key_conf *key)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
|
||||
switch (cmd) {
|
||||
case SET_KEY:
|
||||
if (vnt_set_keys(hw, sta, vif, key))
|
||||
return -EOPNOTSUPP;
|
||||
break;
|
||||
case DISABLE_KEY:
|
||||
if (test_bit(key->hw_key_idx, &priv->key_entry_inuse))
|
||||
clear_bit(key->hw_key_idx, &priv->key_entry_inuse);
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static u64 vnt_get_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
u64 tsf;
|
||||
|
||||
CARDbGetCurrentTSF(priv->PortOffset, &tsf);
|
||||
|
||||
return tsf;
|
||||
}
|
||||
|
||||
static void vnt_set_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
|
||||
u64 tsf)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
|
||||
CARDvUpdateNextTBTT(priv->PortOffset, tsf, vif->bss_conf.beacon_int);
|
||||
}
|
||||
|
||||
static void vnt_reset_tsf(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
|
||||
{
|
||||
struct vnt_private *priv = hw->priv;
|
||||
|
||||
/* reset TSF counter */
|
||||
VNSvOutPortB(priv->PortOffset + MAC_REG_TFTCTL, TFTCTL_TSFCNTRST);
|
||||
}
|
||||
|
||||
static const struct ieee80211_ops vnt_mac_ops = {
|
||||
.tx = vnt_tx_80211,
|
||||
.start = vnt_start,
|
||||
.stop = vnt_stop,
|
||||
.add_interface = vnt_add_interface,
|
||||
.remove_interface = vnt_remove_interface,
|
||||
.config = vnt_config,
|
||||
.bss_info_changed = vnt_bss_info_changed,
|
||||
.prepare_multicast = vnt_prepare_multicast,
|
||||
.configure_filter = vnt_configure,
|
||||
.set_key = vnt_set_key,
|
||||
.get_tsf = vnt_get_tsf,
|
||||
.set_tsf = vnt_set_tsf,
|
||||
.reset_tsf = vnt_reset_tsf,
|
||||
};
|
||||
|
||||
int vnt_init(struct vnt_private *priv)
|
||||
{
|
||||
SET_IEEE80211_PERM_ADDR(priv->hw, priv->abyCurrentNetAddr);
|
||||
|
||||
if (ieee80211_register_hw(priv->hw))
|
||||
return -ENODEV;
|
||||
|
||||
priv->mac_hw = true;
|
||||
|
||||
CARDbRadioPowerOff(priv);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int
|
||||
vt6655_probe(struct pci_dev *pcid, const struct pci_device_id *ent)
|
||||
{
|
||||
PCHIP_INFO pChip_info = (PCHIP_INFO)ent->driver_data;
|
||||
struct vnt_private *priv;
|
||||
struct ieee80211_hw *hw;
|
||||
struct wiphy *wiphy;
|
||||
int rc;
|
||||
|
||||
dev_notice(&pcid->dev,
|
||||
"%s Ver. %s\n", DEVICE_FULL_DRV_NAM, DEVICE_VERSION);
|
||||
|
||||
dev_notice(&pcid->dev,
|
||||
"Copyright (c) 2003 VIA Networking Technologies, Inc.\n");
|
||||
|
||||
hw = ieee80211_alloc_hw(sizeof(*priv), &vnt_mac_ops);
|
||||
if (!hw) {
|
||||
dev_err(&pcid->dev, "could not register ieee80211_hw\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
priv = hw->priv;
|
||||
|
||||
vt6655_init_info(pcid, &priv, pChip_info);
|
||||
|
||||
priv->hw = hw;
|
||||
|
||||
SET_IEEE80211_DEV(priv->hw, &pcid->dev);
|
||||
|
||||
if (pci_enable_device(pcid)) {
|
||||
device_free_info(priv);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
dev_dbg(&pcid->dev,
|
||||
"Before get pci_info memaddr is %x\n", priv->memaddr);
|
||||
|
||||
if (!device_get_pci_info(priv, pcid)) {
|
||||
dev_err(&pcid->dev, ": Failed to find PCI device.\n");
|
||||
device_free_info(priv);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
#ifdef DEBUG
|
||||
dev_dbg(&pcid->dev,
|
||||
"after get pci_info memaddr is %x, io addr is %x,io_size is %d\n",
|
||||
priv->memaddr, priv->ioaddr, priv->io_size);
|
||||
{
|
||||
int i;
|
||||
u32 bar, len;
|
||||
u32 address[] = {
|
||||
PCI_BASE_ADDRESS_0,
|
||||
PCI_BASE_ADDRESS_1,
|
||||
PCI_BASE_ADDRESS_2,
|
||||
PCI_BASE_ADDRESS_3,
|
||||
PCI_BASE_ADDRESS_4,
|
||||
PCI_BASE_ADDRESS_5,
|
||||
0};
|
||||
for (i = 0; address[i]; i++) {
|
||||
pci_read_config_dword(pcid, address[i], &bar);
|
||||
|
||||
dev_dbg(&pcid->dev, "bar %d is %x\n", i, bar);
|
||||
|
||||
if (!bar) {
|
||||
dev_dbg(&pcid->dev,
|
||||
"bar %d not implemented\n", i);
|
||||
continue;
|
||||
}
|
||||
|
||||
if (bar & PCI_BASE_ADDRESS_SPACE_IO) {
|
||||
/* This is IO */
|
||||
|
||||
len = bar & (PCI_BASE_ADDRESS_IO_MASK & 0xffff);
|
||||
len = len & ~(len - 1);
|
||||
|
||||
dev_dbg(&pcid->dev,
|
||||
"IO space: len in IO %x, BAR %d\n",
|
||||
len, i);
|
||||
} else {
|
||||
len = bar & 0xfffffff0;
|
||||
len = ~len + 1;
|
||||
|
||||
dev_dbg(&pcid->dev,
|
||||
"len in MEM %x, BAR %d\n", len, i);
|
||||
}
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
priv->PortOffset = ioremap(priv->memaddr & PCI_BASE_ADDRESS_MEM_MASK,
|
||||
priv->io_size);
|
||||
if (!priv->PortOffset) {
|
||||
dev_err(&pcid->dev, ": Failed to IO remapping ..\n");
|
||||
device_free_info(priv);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
rc = pci_request_regions(pcid, DEVICE_NAME);
|
||||
if (rc) {
|
||||
dev_err(&pcid->dev, ": Failed to find PCI device\n");
|
||||
device_free_info(priv);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
/* do reset */
|
||||
if (!MACbSoftwareReset(priv->PortOffset)) {
|
||||
dev_err(&pcid->dev, ": Failed to access MAC hardware..\n");
|
||||
device_free_info(priv);
|
||||
return -ENODEV;
|
||||
}
|
||||
/* initial to reload eeprom */
|
||||
MACvInitialize(priv->PortOffset);
|
||||
MACvReadEtherAddress(priv->PortOffset, priv->abyCurrentNetAddr);
|
||||
|
||||
device_get_options(priv);
|
||||
device_set_options(priv);
|
||||
/* Mask out the options cannot be set to the chip */
|
||||
priv->sOpts.flags &= pChip_info->flags;
|
||||
|
||||
/* Enable the chip specified capabilities */
|
||||
priv->flags = priv->sOpts.flags | (pChip_info->flags & 0xff000000UL);
|
||||
priv->tx_80211 = device_dma0_tx_80211;
|
||||
priv->sMgmtObj.pAdapter = (void *)priv;
|
||||
priv->pMgmt = &(priv->sMgmtObj);
|
||||
|
||||
wiphy = priv->hw->wiphy;
|
||||
|
||||
wiphy->frag_threshold = FRAG_THRESH_DEF;
|
||||
wiphy->rts_threshold = RTS_THRESH_DEF;
|
||||
wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) |
|
||||
BIT(NL80211_IFTYPE_ADHOC) | BIT(NL80211_IFTYPE_AP);
|
||||
|
||||
priv->hw->flags = IEEE80211_HW_RX_INCLUDES_FCS |
|
||||
IEEE80211_HW_REPORTS_TX_ACK_STATUS |
|
||||
IEEE80211_HW_SIGNAL_DBM |
|
||||
IEEE80211_HW_TIMING_BEACON_ONLY;
|
||||
|
||||
priv->hw->max_signal = 100;
|
||||
|
||||
if (vnt_init(priv))
|
||||
return -ENODEV;
|
||||
|
||||
device_print_info(priv);
|
||||
pci_set_drvdata(pcid, priv);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*------------------------------------------------------------------*/
|
||||
|
||||
MODULE_DEVICE_TABLE(pci, vt6655_pci_id_table);
|
||||
|
||||
Loading…
Reference in New Issue
Block a user