Compare commits
18 Commits
| Author | SHA1 | Date | |
|---|---|---|---|
| d95453c98e | |||
| 8cd10f487c | |||
| 093a5038b8 | |||
| f68fd5530f | |||
| 0750df2611 | |||
| 0ec58c0ad5 | |||
| 42fd0ceab6 | |||
| 4be43770fd | |||
| 3dbabf3092 | |||
| 44b296647b | |||
| 25c0ed8c57 | |||
| 8dd79199f8 | |||
| 979d5436ee | |||
| 1e9eb4581f | |||
| 6a6aa243a4 | |||
| b717251598 | |||
| 65a4c39914 | |||
| 4bc0a34c94 |
+16
-8
@@ -1,12 +1,9 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* mac80211 STA and AP API for mac80211 BES2600 drivers
|
* AP mode for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include "bes2600.h"
|
#include "bes2600.h"
|
||||||
@@ -65,8 +62,11 @@ int bes2600_sta_add(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
|
|||||||
struct bes2600_vif *priv = cw12xx_get_vif_from_ieee80211(vif);
|
struct bes2600_vif *priv = cw12xx_get_vif_from_ieee80211(vif);
|
||||||
struct bes2600_link_entry *entry;
|
struct bes2600_link_entry *entry;
|
||||||
struct sk_buff *skb;
|
struct sk_buff *skb;
|
||||||
|
struct sk_buff_head local_drain;
|
||||||
struct bes2600_common *hw_priv = hw->priv;
|
struct bes2600_common *hw_priv = hw->priv;
|
||||||
|
|
||||||
|
__skb_queue_head_init(&local_drain);
|
||||||
|
|
||||||
#ifdef P2P_MULTIVIF
|
#ifdef P2P_MULTIVIF
|
||||||
WARN_ON(priv->if_id == CW12XX_GENERIC_IF_ID);
|
WARN_ON(priv->if_id == CW12XX_GENERIC_IF_ID);
|
||||||
#endif
|
#endif
|
||||||
@@ -95,9 +95,17 @@ int bes2600_sta_add(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
|
|||||||
IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
|
IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
|
||||||
priv->sta_asleep_mask |= BIT(sta_priv->link_id);
|
priv->sta_asleep_mask |= BIT(sta_priv->link_id);
|
||||||
entry->status = BES2600_LINK_HARD;
|
entry->status = BES2600_LINK_HARD;
|
||||||
while ((skb = skb_dequeue(&entry->rx_queue)))
|
/*
|
||||||
ieee80211_rx_irqsafe(priv->hw, skb);
|
* Patch C2: splice the rx_queue out under the lock then deliver
|
||||||
|
* after unlock. ieee80211_rx_ni() runs the mac80211 RX path
|
||||||
|
* synchronously (formerly ieee80211_rx_irqsafe deferred to a
|
||||||
|
* tasklet); calling it from inside spin_lock_bh would hold the
|
||||||
|
* lock across mac80211's full RX dispatch.
|
||||||
|
*/
|
||||||
|
skb_queue_splice_init(&entry->rx_queue, &local_drain);
|
||||||
spin_unlock_bh(&priv->ps_state_lock);
|
spin_unlock_bh(&priv->ps_state_lock);
|
||||||
|
while ((skb = __skb_dequeue(&local_drain)))
|
||||||
|
ieee80211_rx_ni(priv->hw, skb);
|
||||||
#ifdef AP_AGGREGATE_FW_FIX
|
#ifdef AP_AGGREGATE_FW_FIX
|
||||||
hw_priv->connected_sta_cnt++;
|
hw_priv->connected_sta_cnt++;
|
||||||
if(hw_priv->connected_sta_cnt>1) {
|
if(hw_priv->connected_sta_cnt>1) {
|
||||||
|
|||||||
+3
-6
@@ -1,12 +1,9 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* mac80211 STA and AP API for mac80211 BES2600 drivers
|
* AP mode interface for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#include <linux/version.h>
|
#include <linux/version.h>
|
||||||
#ifndef AP_H_INCLUDED
|
#ifndef AP_H_INCLUDED
|
||||||
|
|||||||
+21
-16
@@ -1,18 +1,15 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Common private data for BES2600 drivers
|
* Common private data for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* Based on the mac80211 Prism54 code, which is
|
* Based on the mac80211 Prism54 code, which is
|
||||||
* Copyright (c) 2006, Michael Wu <flamingice@sourmilk.net>
|
* Copyright (c) 2006, Michael Wu <flamingice@sourmilk.net>
|
||||||
*
|
*
|
||||||
* Based on the islsm (softmac prism54) driver, which is:
|
* Based on the islsm (softmac prism54) driver, which is
|
||||||
* Copyright 2004-2006 Jean-Baptiste Note <jbnote@gmail.com>, et al.
|
* Copyright 2004-2006 Jean-Baptiste Note <jbnote@gmail.com>, et al.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef BES2600_H
|
#ifndef BES2600_H
|
||||||
@@ -356,15 +353,23 @@ struct bes2600_common {
|
|||||||
* Keeping in common structure for the time being. Will be moved to VIFF
|
* Keeping in common structure for the time being. Will be moved to VIFF
|
||||||
* after the mechanism is clear */
|
* after the mechanism is clear */
|
||||||
u8 ba_tid_mask;
|
u8 ba_tid_mask;
|
||||||
int ba_acc; /*TODO: Same as above */
|
/*
|
||||||
int ba_cnt; /*TODO: Same as above */
|
* Patch D: ba_lock removed. Per-frame TX/RX hot-path bumped these
|
||||||
int ba_cnt_rx; /*TODO: Same as above */
|
* counters under spin_lock_bh; the lock did not protect any
|
||||||
int ba_acc_rx; /*TODO: Same as above */
|
* compound invariant that atomic ops can't satisfy. Counters are
|
||||||
int ba_hist; /*TODO: Same as above */
|
* now atomic_t; ba_armed gates the once-per-window mod_timer
|
||||||
struct timer_list ba_timer;/*TODO: Same as above */
|
* arm via cmpxchg so concurrent TX/RX at a fresh window each
|
||||||
spinlock_t ba_lock; /*TODO: Same as above */
|
* try to claim the arm and exactly one succeeds.
|
||||||
bool ba_ena; /*TODO: Same as above */
|
*/
|
||||||
struct work_struct ba_work; /*TODO: Same as above */
|
atomic_t ba_acc;
|
||||||
|
atomic_t ba_cnt;
|
||||||
|
atomic_t ba_cnt_rx;
|
||||||
|
atomic_t ba_acc_rx;
|
||||||
|
atomic_t ba_armed;
|
||||||
|
int ba_hist;
|
||||||
|
struct timer_list ba_timer;
|
||||||
|
atomic_t ba_ena;
|
||||||
|
struct work_struct ba_work;
|
||||||
bool is_BT_Present;
|
bool is_BT_Present;
|
||||||
bool is_go_thru_go_neg;
|
bool is_go_thru_go_neg;
|
||||||
u8 conf_listen_interval;
|
u8 conf_listen_interval;
|
||||||
|
|||||||
@@ -1,12 +1,9 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Factory calibration loader for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
|
|||||||
@@ -1,12 +1,9 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Factory calibration loader interface
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#ifndef __FACTORY_H__
|
#ifndef __FACTORY_H__
|
||||||
#define __FACTORY_H__
|
#define __FACTORY_H__
|
||||||
|
|||||||
@@ -1,12 +1,9 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Platform data for BES2600 SDIO bus
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#ifndef BES2600_PLAT_H_INCLUDED
|
#ifndef BES2600_PLAT_H_INCLUDED
|
||||||
#define BES2600_PLAT_H_INCLUDED
|
#define BES2600_PLAT_H_INCLUDED
|
||||||
|
|||||||
+91
-66
@@ -1,12 +1,13 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 SDIO driver for BES2600 device
|
* SDIO bus glue for BES2600 mac80211 driver
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
|
* Derived from drivers/net/wireless/st/cw1200/cw1200_sdio.c
|
||||||
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#define DEBUG 1
|
#define DEBUG 1
|
||||||
#include <linux/version.h>
|
#include <linux/version.h>
|
||||||
@@ -29,6 +30,7 @@
|
|||||||
#include <linux/of_gpio.h>
|
#include <linux/of_gpio.h>
|
||||||
|
|
||||||
#include "bes2600.h"
|
#include "bes2600.h"
|
||||||
|
#include "bh.h"
|
||||||
#include "sbus.h"
|
#include "sbus.h"
|
||||||
#include "bes2600_plat.h"
|
#include "bes2600_plat.h"
|
||||||
#include "bes2600_factory.h"
|
#include "bes2600_factory.h"
|
||||||
@@ -72,10 +74,12 @@ struct sbus_priv {
|
|||||||
int rx_data_toggle;
|
int rx_data_toggle;
|
||||||
#endif
|
#endif
|
||||||
#ifdef BES_SDIO_RX_MULTIPLE_ENABLE
|
#ifdef BES_SDIO_RX_MULTIPLE_ENABLE
|
||||||
spinlock_t rx_queue_lock;
|
/*
|
||||||
struct sk_buff_head rx_queue;
|
* Patch C v3: rx_queue, rx_queue_lock, rx_work removed (no relay).
|
||||||
|
* The bh thread now reads RX inline; the rx_buffer scratch area
|
||||||
|
* stays. Counters/timestamps stay for debugfs visibility.
|
||||||
|
*/
|
||||||
u8 *rx_buffer;
|
u8 *rx_buffer;
|
||||||
struct work_struct rx_work;
|
|
||||||
u32 rx_last_ctrl;
|
u32 rx_last_ctrl;
|
||||||
u32 rx_valid_ctrl;
|
u32 rx_valid_ctrl;
|
||||||
u32 rx_total_ctrl_cnt;
|
u32 rx_total_ctrl_cnt;
|
||||||
@@ -412,10 +416,19 @@ static void bes2600_sdio_irq_handler(struct sdio_func *func)
|
|||||||
|
|
||||||
bes_devel("%s called, fw_started:%d \n",
|
bes_devel("%s called, fw_started:%d \n",
|
||||||
__func__, self->fw_started);
|
__func__, self->fw_started);
|
||||||
if (likely(self->fw_started && self->core)) {
|
/*
|
||||||
queue_work(self->sdio_wq, &self->rx_work);
|
* Patch C v3: no more sdio_rx_work relay. Wake the bh thread
|
||||||
|
* directly via self->irq_handler (bes2600_irq_handler in bh.c
|
||||||
|
* which bumps bh_rx atomic + wakes bh_wq). The bh thread will
|
||||||
|
* then call sbus_ops->bus_rx_batch() to do the SDIO read inline.
|
||||||
|
* Matches cw1200 mainline IRQ → bh-direct architecture.
|
||||||
|
*/
|
||||||
|
if (likely(self->fw_started && self->core && self->irq_handler)) {
|
||||||
|
spin_lock_irqsave(&self->lock, flags);
|
||||||
|
self->irq_handler(self->irq_priv);
|
||||||
|
spin_unlock_irqrestore(&self->lock, flags);
|
||||||
self->last_irq_timestamp = jiffies;
|
self->last_irq_timestamp = jiffies;
|
||||||
} else if(self->irq_handler) {
|
} else if (self->irq_handler) {
|
||||||
spin_lock_irqsave(&self->lock, flags);
|
spin_lock_irqsave(&self->lock, flags);
|
||||||
self->irq_handler(self->irq_priv);
|
self->irq_handler(self->irq_priv);
|
||||||
spin_unlock_irqrestore(&self->lock, flags);
|
spin_unlock_irqrestore(&self->lock, flags);
|
||||||
@@ -812,10 +825,15 @@ static int bes2600_sdio_extract_packets(struct sbus_priv *self, u32 ctrl_reg, u8
|
|||||||
skb_put(skb, packet_len);
|
skb_put(skb, packet_len);
|
||||||
memcpy(skb->data, &data[pos], packet_len);
|
memcpy(skb->data, &data[pos], packet_len);
|
||||||
bes_devel("%s, %d,%d\n", __func__, packet_len, pos);
|
bes_devel("%s, %d,%d\n", __func__, packet_len, pos);
|
||||||
spin_lock(&self->rx_queue_lock);
|
|
||||||
skb_queue_tail(&self->rx_queue, skb);
|
|
||||||
self->rx_data_cnt++;
|
self->rx_data_cnt++;
|
||||||
spin_unlock(&self->rx_queue_lock);
|
/*
|
||||||
|
* Patch C v3: deliver the SKB directly into the WSM/mac80211
|
||||||
|
* stack from the bh thread. No rx_queue, no inter-thread
|
||||||
|
* handoff, no atomic_t needed on the counters that
|
||||||
|
* wsm_release_tx_buffer touches — single-writer-from-bh is
|
||||||
|
* preserved by construction. See bh.c for the contract block.
|
||||||
|
*/
|
||||||
|
bes2600_bh_handle_rx_skb(self->core, skb);
|
||||||
packet_len = (packet_len + 3) & (~0x3);
|
packet_len = (packet_len + 3) & (~0x3);
|
||||||
pos += packet_len;
|
pos += packet_len;
|
||||||
#ifdef BES_SDIO_OPTIMIZED_LEN
|
#ifdef BES_SDIO_OPTIMIZED_LEN
|
||||||
@@ -826,17 +844,31 @@ static int bes2600_sdio_extract_packets(struct sbus_priv *self, u32 ctrl_reg, u8
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void sdio_rx_work(struct work_struct *work)
|
/*
|
||||||
|
* Patch C v3: bh thread calls this directly via sbus_ops->bus_rx_batch.
|
||||||
|
* No more sdio_rx_work workqueue. SDIO read sequence (lock →
|
||||||
|
* read_ctrl → memcpy_fromio → packets_check → extract_packets) runs
|
||||||
|
* inline in bh-thread context. Each parsed SKB is delivered via
|
||||||
|
* bes2600_bh_handle_rx_skb() from extract_packets — no rx_queue, no
|
||||||
|
* second worker, no inter-thread handoff.
|
||||||
|
*
|
||||||
|
* Architecture matches cw1200 mainline. Single-writer-from-bh
|
||||||
|
* invariant on hw_bufs_used preserved by construction.
|
||||||
|
*
|
||||||
|
* Returns 0 on success (caller's bh outer loop decides whether to
|
||||||
|
* continue), negative on bus read error. On error: triggers
|
||||||
|
* wifi_force_close (same as the old sdio_rx_work).
|
||||||
|
*/
|
||||||
|
static int bes2600_sdio_read_rx_batch(struct sbus_priv *self)
|
||||||
{
|
{
|
||||||
int ret, again = 0, retry = 0, crc_retry = 0;
|
int ret = 0, again = 0, retry = 0, crc_retry = 0;
|
||||||
u32 ctrl_reg = 0;
|
u32 ctrl_reg = 0;
|
||||||
int total_len;
|
int total_len;
|
||||||
struct sbus_priv *self = container_of(work, struct sbus_priv, rx_work);
|
|
||||||
u8 *buf = self->rx_buffer;
|
u8 *buf = self->rx_buffer;
|
||||||
|
|
||||||
/* don't read/write sdio when sdio error */
|
/* don't read/write sdio when sdio error */
|
||||||
if (bes2600_chrdev_is_bus_error())
|
if (bes2600_chrdev_is_bus_error())
|
||||||
return;
|
return 0;
|
||||||
|
|
||||||
bes2600_gpio_wakeup_mcu(self, GPIO_WAKE_FLAG_SDIO_RX);
|
bes2600_gpio_wakeup_mcu(self, GPIO_WAKE_FLAG_SDIO_RX);
|
||||||
|
|
||||||
@@ -891,6 +923,10 @@ static void sdio_rx_work(struct work_struct *work)
|
|||||||
goto failed;
|
goto failed;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* extract_packets parses the multi-RX buffer and calls
|
||||||
|
* bes2600_bh_handle_rx_skb() per SKB. No queueing.
|
||||||
|
*/
|
||||||
if ((ret = bes2600_sdio_extract_packets(self, ctrl_reg, buf))) {
|
if ((ret = bes2600_sdio_extract_packets(self, ctrl_reg, buf))) {
|
||||||
bes_err("%s,%d error=%d\n", __func__, __LINE__, ret);
|
bes_err("%s,%d error=%d\n", __func__, __LINE__, ret);
|
||||||
goto failed;
|
goto failed;
|
||||||
@@ -898,22 +934,16 @@ static void sdio_rx_work(struct work_struct *work)
|
|||||||
|
|
||||||
ctrl_reg = 0;
|
ctrl_reg = 0;
|
||||||
|
|
||||||
if (likely(self->irq_handler)) {
|
|
||||||
self->irq_handler(self->irq_priv);
|
|
||||||
} else {
|
|
||||||
bes_err("%s,%d\n", __func__, __LINE__);
|
|
||||||
goto failed;
|
|
||||||
}
|
|
||||||
|
|
||||||
} while (again);
|
} while (again);
|
||||||
|
|
||||||
bes2600_gpio_allow_mcu_sleep(self, GPIO_WAKE_FLAG_SDIO_RX);
|
bes2600_gpio_allow_mcu_sleep(self, GPIO_WAKE_FLAG_SDIO_RX);
|
||||||
return;
|
return 0;
|
||||||
|
|
||||||
failed:
|
failed:
|
||||||
bes2600_gpio_allow_mcu_sleep(self, GPIO_WAKE_FLAG_SDIO_RX);
|
bes2600_gpio_allow_mcu_sleep(self, GPIO_WAKE_FLAG_SDIO_RX);
|
||||||
bes2600_chrdev_wifi_force_close(self->core, false);
|
bes2600_chrdev_wifi_force_close(self->core, false);
|
||||||
WARN_ON(1);
|
WARN_ON(1);
|
||||||
|
return -1;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void sdio_scan_work(struct work_struct *work)
|
static void sdio_scan_work(struct work_struct *work)
|
||||||
@@ -921,26 +951,11 @@ static void sdio_scan_work(struct work_struct *work)
|
|||||||
bes_warn("%s: this function does nothing\n", __FUNCTION__);
|
bes_warn("%s: this function does nothing\n", __FUNCTION__);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void *bes2600_sdio_pipe_read(struct sbus_priv *self)
|
/* Patch C v3: bes2600_sdio_pipe_read deleted. bh thread reads the
|
||||||
{
|
* SDIO bus inline via bes2600_sdio_read_rx_batch (sbus_ops->bus_rx_batch).
|
||||||
struct sk_buff *skb;
|
* No rx_queue, no skb_dequeue, no relay. bes2600_tx_loop_read remains
|
||||||
|
* for the test bus error-fallback path but is now invoked at higher
|
||||||
if (bes2600_chrdev_is_bus_error()) {
|
* level. */
|
||||||
return bes2600_tx_loop_read(self->core);
|
|
||||||
}
|
|
||||||
|
|
||||||
spin_lock(&self->rx_queue_lock);
|
|
||||||
skb = skb_dequeue(&self->rx_queue);
|
|
||||||
if (skb)
|
|
||||||
self->rx_proc_cnt++;
|
|
||||||
spin_unlock(&self->rx_queue_lock);
|
|
||||||
if (likely(self->fw_started == true &&
|
|
||||||
!bes2600_pwr_device_is_idle(self->core) &&
|
|
||||||
self->core->hw_bufs_used > 0))
|
|
||||||
if (!skb)
|
|
||||||
queue_work(self->sdio_wq, &self->rx_work);
|
|
||||||
return skb;
|
|
||||||
}
|
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
@@ -1196,7 +1211,14 @@ flush_previous:
|
|||||||
}
|
}
|
||||||
} while (crc_retry <= 10);
|
} while (crc_retry <= 10);
|
||||||
sdio_release_host(self->func);
|
sdio_release_host(self->func);
|
||||||
queue_work(self->sdio_wq, &self->rx_work);
|
/*
|
||||||
|
* Patch C v3: wake the bh thread to check for any RX
|
||||||
|
* that piggybacked on this TX window. Bumps bh_rx
|
||||||
|
* atomic; bh's wait_event will pick it up and call
|
||||||
|
* sbus_ops->bus_rx_batch().
|
||||||
|
*/
|
||||||
|
if (likely(self->irq_handler))
|
||||||
|
self->irq_handler(self->irq_priv);
|
||||||
if (ret) {
|
if (ret) {
|
||||||
bes_err("%s,%d err=%d,%d,%d\n", __func__, __LINE__, ret, scatters, cur_blk);
|
bes_err("%s,%d err=%d,%d,%d\n", __func__, __LINE__, ret, scatters, cur_blk);
|
||||||
sdio_work_debug(self);
|
sdio_work_debug(self);
|
||||||
@@ -1247,12 +1269,11 @@ static int bes2600_sdio_misc_init(struct sbus_priv *self, struct bes2600_common
|
|||||||
self->next_toggle = 0;
|
self->next_toggle = 0;
|
||||||
#endif
|
#endif
|
||||||
#ifdef BES_SDIO_RX_MULTIPLE_ENABLE
|
#ifdef BES_SDIO_RX_MULTIPLE_ENABLE
|
||||||
spin_lock_init(&self->rx_queue_lock);
|
/* Patch C v3: rx_queue / rx_queue_lock removed (no relay). */
|
||||||
skb_queue_head_init(&self->rx_queue);
|
|
||||||
self->rx_buffer = (u8 *)__get_dma_pages(GFP_KERNEL, get_order(1632 * BES_SDIO_RX_MULTIPLE_NUM));
|
self->rx_buffer = (u8 *)__get_dma_pages(GFP_KERNEL, get_order(1632 * BES_SDIO_RX_MULTIPLE_NUM));
|
||||||
if (!self->rx_buffer)
|
if (!self->rx_buffer)
|
||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
INIT_WORK(&self->rx_work, sdio_rx_work);
|
/* Patch C v3: sdio_rx_work removed; bh thread does the read. */
|
||||||
#endif
|
#endif
|
||||||
#ifdef BES_SDIO_TX_MULTIPLE_ENABLE
|
#ifdef BES_SDIO_TX_MULTIPLE_ENABLE
|
||||||
INIT_LIST_HEAD(&self->tx_bufferlist);
|
INIT_LIST_HEAD(&self->tx_bufferlist);
|
||||||
@@ -1581,22 +1602,15 @@ err:
|
|||||||
|
|
||||||
static void bes2600_sdio_empty_work(struct sbus_priv *self)
|
static void bes2600_sdio_empty_work(struct sbus_priv *self)
|
||||||
{
|
{
|
||||||
#ifdef BES_SDIO_RX_MULTIPLE_ENABLE
|
|
||||||
struct sk_buff *skb;
|
|
||||||
#endif
|
|
||||||
#ifdef BES_SDIO_TX_MULTIPLE_ENABLE
|
#ifdef BES_SDIO_TX_MULTIPLE_ENABLE
|
||||||
struct bes_sdio_tx_list_t *tx_buffer, *temp;
|
struct bes_sdio_tx_list_t *tx_buffer, *temp;
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#ifdef BES_SDIO_RX_MULTIPLE_ENABLE
|
#ifdef BES_SDIO_RX_MULTIPLE_ENABLE
|
||||||
cancel_work_sync(&self->rx_work);
|
/*
|
||||||
while (1) {
|
* Patch C v3: rx_work and rx_queue removed. Counters still
|
||||||
skb = skb_dequeue(&self->rx_queue);
|
* reset for the next attach cycle.
|
||||||
if (skb)
|
*/
|
||||||
dev_kfree_skb(skb);
|
|
||||||
else
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
self->rx_last_ctrl = 0;
|
self->rx_last_ctrl = 0;
|
||||||
self->rx_total_ctrl_cnt = 0;
|
self->rx_total_ctrl_cnt = 0;
|
||||||
self->rx_continuous_ctrl_cnt = 0;
|
self->rx_continuous_ctrl_cnt = 0;
|
||||||
@@ -1864,7 +1878,8 @@ static struct sbus_ops bes2600_sdio_sbus_ops = {
|
|||||||
.sbus_reg_write = bes2600_sdio_reg_write,
|
.sbus_reg_write = bes2600_sdio_reg_write,
|
||||||
.init = bes2600_sdio_misc_init,
|
.init = bes2600_sdio_misc_init,
|
||||||
#ifdef BES_SDIO_RX_MULTIPLE_ENABLE
|
#ifdef BES_SDIO_RX_MULTIPLE_ENABLE
|
||||||
.pipe_read = bes2600_sdio_pipe_read,
|
/* Patch C v3: .pipe_read removed; bus_rx_batch replaces it. */
|
||||||
|
.bus_rx_batch = bes2600_sdio_read_rx_batch,
|
||||||
#endif
|
#endif
|
||||||
#ifdef BES_SDIO_TX_MULTIPLE_ENABLE
|
#ifdef BES_SDIO_TX_MULTIPLE_ENABLE
|
||||||
.pipe_send = bes2600_sdio_pipe_send,
|
.pipe_send = bes2600_sdio_pipe_send,
|
||||||
@@ -1884,9 +1899,15 @@ static void bes2600_sdio_en_lp_cb(struct bes2600_common *hw_priv)
|
|||||||
long unsigned int old_ts, new_ts;
|
long unsigned int old_ts, new_ts;
|
||||||
struct sbus_priv *self = hw_priv->sbus_priv;
|
struct sbus_priv *self = hw_priv->sbus_priv;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Patch C v3: rx_work removed. Wait for IRQ-timestamp activity
|
||||||
|
* to settle by polling self->last_irq_timestamp via msleep
|
||||||
|
* (best-effort). The caller already knows the bh thread will
|
||||||
|
* process pending bh_rx during its next wait_event round.
|
||||||
|
*/
|
||||||
do {
|
do {
|
||||||
old_ts = self->last_irq_timestamp;
|
old_ts = self->last_irq_timestamp;
|
||||||
flush_work(&self->rx_work);
|
msleep(2);
|
||||||
new_ts = self->last_irq_timestamp;
|
new_ts = self->last_irq_timestamp;
|
||||||
} while(old_ts != new_ts);
|
} while(old_ts != new_ts);
|
||||||
}
|
}
|
||||||
@@ -2244,8 +2265,12 @@ static int bes2600_sdio_suspend_noirq(struct device *dev)
|
|||||||
if (func->num > 1)
|
if (func->num > 1)
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
if(self->core &&
|
/*
|
||||||
(work_pending(&self->rx_work) || atomic_read(&self->core->bh_rx))) {
|
* Patch C v3: work_pending(&self->rx_work) check dropped (no
|
||||||
|
* relay). bh_rx atomic alone tells us whether the bh thread
|
||||||
|
* has un-processed RX events queued.
|
||||||
|
*/
|
||||||
|
if (self->core && atomic_read(&self->core->bh_rx)) {
|
||||||
bes_devel("%s: Suspend interrupted.\n", __func__);
|
bes_devel("%s: Suspend interrupted.\n", __func__);
|
||||||
return -EAGAIN;
|
return -EAGAIN;
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -1,12 +1,9 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Character device for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#include<linux/module.h>
|
#include<linux/module.h>
|
||||||
#include <linux/init.h>
|
#include <linux/init.h>
|
||||||
|
|||||||
@@ -1,12 +1,9 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Character device interface for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#ifndef __BES_CHARDEV_H__
|
#ifndef __BES_CHARDEV_H__
|
||||||
#define __BES_CHARDEV_H__
|
#define __BES_CHARDEV_H__
|
||||||
|
|||||||
+3
-6
@@ -1,12 +1,9 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Firmware download for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#include "bes_fw_common.h"
|
#include "bes_fw_common.h"
|
||||||
#include "bes2600.h"
|
#include "bes2600.h"
|
||||||
|
|||||||
@@ -1,12 +1,9 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Firmware download common code for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#include "bes_fw_common.h"
|
#include "bes_fw_common.h"
|
||||||
#include "bes_log.h"
|
#include "bes_log.h"
|
||||||
|
|||||||
@@ -1,12 +1,9 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Firmware download common interface
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#ifndef __BES_FW_COMMON_H__
|
#ifndef __BES_FW_COMMON_H__
|
||||||
#define __BES_FW_COMMON_H__
|
#define __BES_FW_COMMON_H__
|
||||||
|
|||||||
@@ -1,3 +1,10 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
|
/*
|
||||||
|
* printk wrappers for BES2600
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
|
*
|
||||||
|
*/
|
||||||
extern struct device *global_dev;
|
extern struct device *global_dev;
|
||||||
|
|
||||||
#ifdef CONFIG_BES2600_ENABLE_DEVEL_LOGS
|
#ifdef CONFIG_BES2600_ENABLE_DEVEL_LOGS
|
||||||
|
|||||||
@@ -1,12 +1,9 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Vendor testmode messages for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef BES_NL80211_TESTMODE_MSG_H
|
#ifndef BES_NL80211_TESTMODE_MSG_H
|
||||||
|
|||||||
+3
-6
@@ -1,12 +1,9 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Chip-side power state machine for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#include <linux/list.h>
|
#include <linux/list.h>
|
||||||
#include <linux/pm.h>
|
#include <linux/pm.h>
|
||||||
|
|||||||
+3
-6
@@ -1,12 +1,9 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Chip-side power state machine interface
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#ifndef __BES_PWR_H__
|
#ifndef __BES_PWR_H__
|
||||||
#define __BES_PWR_H__
|
#define __BES_PWR_H__
|
||||||
|
|||||||
+153
-570
@@ -1,12 +1,12 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Bottom-half thread for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#include <net/mac80211.h>
|
#include <net/mac80211.h>
|
||||||
#include <linux/kthread.h>
|
#include <linux/kthread.h>
|
||||||
@@ -101,7 +101,7 @@ void bes2600_unregister_bh(struct bes2600_common *hw_priv)
|
|||||||
coex_deinit_mode(hw_priv);
|
coex_deinit_mode(hw_priv);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
atomic_add(1, &hw_priv->bh_term);
|
atomic_inc(&hw_priv->bh_term);
|
||||||
wake_up(&hw_priv->bh_wq);
|
wake_up(&hw_priv->bh_wq);
|
||||||
|
|
||||||
flush_workqueue(hw_priv->bh_workqueue);
|
flush_workqueue(hw_priv->bh_workqueue);
|
||||||
@@ -316,83 +316,6 @@ int wsm_release_buffer_to_fw(struct bes2600_vif *priv, int count)
|
|||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#if 0
|
|
||||||
static struct sk_buff *bes2600_get_skb(struct bes2600_common *hw_priv, size_t len)
|
|
||||||
{
|
|
||||||
struct sk_buff *skb;
|
|
||||||
size_t alloc_len = (len > SDIO_BLOCK_SIZE) ? len : SDIO_BLOCK_SIZE;
|
|
||||||
|
|
||||||
if (len > SDIO_BLOCK_SIZE || !hw_priv->skb_cache) {
|
|
||||||
skb = dev_alloc_skb(alloc_len
|
|
||||||
+ WSM_TX_EXTRA_HEADROOM
|
|
||||||
+ 8 /* TKIP IV */
|
|
||||||
+ 12 /* TKIP ICV + MIC */
|
|
||||||
- 2 /* Piggyback */);
|
|
||||||
/* In AP mode RXed SKB can be looped back as a broadcast.
|
|
||||||
* Here we reserve enough space for headers. */
|
|
||||||
skb_reserve(skb, WSM_TX_EXTRA_HEADROOM
|
|
||||||
+ 8 /* TKIP IV */
|
|
||||||
- WSM_RX_EXTRA_HEADROOM);
|
|
||||||
} else {
|
|
||||||
skb = hw_priv->skb_cache;
|
|
||||||
hw_priv->skb_cache = NULL;
|
|
||||||
}
|
|
||||||
return skb;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void bes2600_put_skb(struct bes2600_common *hw_priv, struct sk_buff *skb)
|
|
||||||
{
|
|
||||||
if (hw_priv->skb_cache)
|
|
||||||
dev_kfree_skb(skb);
|
|
||||||
else
|
|
||||||
hw_priv->skb_cache = skb;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int bes2600_bh_read_ctrl_reg(struct bes2600_common *hw_priv,
|
|
||||||
u16 *ctrl_reg)
|
|
||||||
{
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
ret = bes2600_reg_read_16(hw_priv,
|
|
||||||
ST90TDS_CONTROL_REG_ID, ctrl_reg);
|
|
||||||
if (ret) {
|
|
||||||
ret = bes2600_reg_read_16(hw_priv,
|
|
||||||
ST90TDS_CONTROL_REG_ID, ctrl_reg);
|
|
||||||
if (ret)
|
|
||||||
bes_err("[BH] Failed to read control register.\n");
|
|
||||||
}
|
|
||||||
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int bes2600_device_wakeup(struct bes2600_common *hw_priv)
|
|
||||||
{
|
|
||||||
u16 ctrl_reg;
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
bes_devel("[BH] Device wakeup.\n");
|
|
||||||
|
|
||||||
/* To force the device to be always-on, the host sets WLAN_UP to 1 */
|
|
||||||
ret = bes2600_reg_write_16(hw_priv, ST90TDS_CONTROL_REG_ID,
|
|
||||||
ST90TDS_CONT_WUP_BIT);
|
|
||||||
if (WARN_ON(ret))
|
|
||||||
return ret;
|
|
||||||
|
|
||||||
ret = bes2600_bh_read_ctrl_reg(hw_priv, &ctrl_reg);
|
|
||||||
if (WARN_ON(ret))
|
|
||||||
return ret;
|
|
||||||
|
|
||||||
/* If the device returns WLAN_RDY as 1, the device is active and will
|
|
||||||
* remain active. */
|
|
||||||
if (ctrl_reg & ST90TDS_CONT_RDY_BIT) {
|
|
||||||
bes_devel("[BH] Device awake.\n");
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/* Must be called from BH thraed. */
|
/* Must be called from BH thraed. */
|
||||||
void bes2600_enable_powersave(struct bes2600_vif *priv,
|
void bes2600_enable_powersave(struct bes2600_vif *priv,
|
||||||
@@ -402,475 +325,6 @@ void bes2600_enable_powersave(struct bes2600_vif *priv,
|
|||||||
priv->powersave_enabled = enable;
|
priv->powersave_enabled = enable;
|
||||||
}
|
}
|
||||||
|
|
||||||
#if 0
|
|
||||||
#define INTERRUPT_WORKAROUND
|
|
||||||
static int bes2600_bh(void *arg)
|
|
||||||
{
|
|
||||||
struct bes2600_common *hw_priv = arg;
|
|
||||||
struct bes2600_vif *priv = NULL;
|
|
||||||
struct sk_buff *skb_rx = NULL;
|
|
||||||
size_t read_len = 0;
|
|
||||||
int rx, tx, term, suspend;
|
|
||||||
struct wsm_hdr *wsm;
|
|
||||||
size_t wsm_len;
|
|
||||||
int wsm_id;
|
|
||||||
u8 wsm_seq;
|
|
||||||
int rx_resync = 1;
|
|
||||||
u16 ctrl_reg = 0;
|
|
||||||
int tx_allowed;
|
|
||||||
int pending_tx = 0;
|
|
||||||
int tx_burst;
|
|
||||||
int rx_burst = 0;
|
|
||||||
long status;
|
|
||||||
#if defined(CONFIG_BES2600_WSM_DUMPS)
|
|
||||||
size_t wsm_dump_max = -1;
|
|
||||||
#endif
|
|
||||||
u32 dummy;
|
|
||||||
bool powersave_enabled;
|
|
||||||
int i;
|
|
||||||
int vif_selected;
|
|
||||||
|
|
||||||
for (;;) {
|
|
||||||
powersave_enabled = 1;
|
|
||||||
spin_lock(&hw_priv->vif_list_lock);
|
|
||||||
bes2600_for_each_vif(hw_priv, priv, i) {
|
|
||||||
#ifdef P2P_MULTIVIF
|
|
||||||
if ((i = (CW12XX_MAX_VIFS - 1)) || !priv)
|
|
||||||
#else
|
|
||||||
if (!priv)
|
|
||||||
#endif
|
|
||||||
continue;
|
|
||||||
powersave_enabled &= !!priv->powersave_enabled;
|
|
||||||
}
|
|
||||||
spin_unlock(&hw_priv->vif_list_lock);
|
|
||||||
if (!hw_priv->hw_bufs_used
|
|
||||||
&& powersave_enabled
|
|
||||||
&& !hw_priv->device_can_sleep
|
|
||||||
&& !atomic_read(&hw_priv->recent_scan)) {
|
|
||||||
status = HZ/8;
|
|
||||||
bes_devel("[BH] No Device wakedown.\n");
|
|
||||||
#ifndef FPGA_SETUP
|
|
||||||
WARN_ON(bes2600_reg_write_16(hw_priv,
|
|
||||||
ST90TDS_CONTROL_REG_ID, 0));
|
|
||||||
hw_priv->device_can_sleep = true;
|
|
||||||
#endif
|
|
||||||
} else if (hw_priv->hw_bufs_used)
|
|
||||||
/* Interrupt loss detection */
|
|
||||||
status = HZ/8;
|
|
||||||
else
|
|
||||||
status = HZ/8;
|
|
||||||
|
|
||||||
/* Dummy Read for SDIO retry mechanism*/
|
|
||||||
if (((atomic_read(&hw_priv->bh_rx) == 0) &&
|
|
||||||
(atomic_read(&hw_priv->bh_tx) == 0)))
|
|
||||||
bes2600_reg_read(hw_priv, ST90TDS_CONFIG_REG_ID,
|
|
||||||
&dummy, sizeof(dummy));
|
|
||||||
#if defined(CONFIG_BES2600_WSM_DUMPS_SHORT)
|
|
||||||
wsm_dump_max = hw_priv->wsm_dump_max_size;
|
|
||||||
#endif /* CONFIG_BES2600_WSM_DUMPS_SHORT */
|
|
||||||
|
|
||||||
#ifdef INTERRUPT_WORKAROUND
|
|
||||||
/* If a packet has already been txed to the device then read the
|
|
||||||
control register for a probable interrupt miss before going
|
|
||||||
further to wait for interrupt; if the read length is non-zero
|
|
||||||
then it means there is some data to be received */
|
|
||||||
if (hw_priv->hw_bufs_used) {
|
|
||||||
bes2600_bh_read_ctrl_reg(hw_priv, &ctrl_reg);
|
|
||||||
if(ctrl_reg & ST90TDS_CONT_NEXT_LEN_MASK)
|
|
||||||
{
|
|
||||||
rx = 1;
|
|
||||||
goto test;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
status = wait_event_interruptible_timeout(hw_priv->bh_wq, ({
|
|
||||||
rx = atomic_xchg(&hw_priv->bh_rx, 0);
|
|
||||||
tx = atomic_xchg(&hw_priv->bh_tx, 0);
|
|
||||||
term = atomic_xchg(&hw_priv->bh_term, 0);
|
|
||||||
suspend = pending_tx ?
|
|
||||||
0 : atomic_read(&hw_priv->bh_suspend);
|
|
||||||
(rx || tx || term || suspend || hw_priv->bh_error);
|
|
||||||
}), status);
|
|
||||||
|
|
||||||
if (status < 0 || term || hw_priv->bh_error)
|
|
||||||
break;
|
|
||||||
|
|
||||||
#ifdef INTERRUPT_WORKAROUND
|
|
||||||
if (!status) {
|
|
||||||
bes2600_bh_read_ctrl_reg(hw_priv, &ctrl_reg);
|
|
||||||
if(ctrl_reg & ST90TDS_CONT_NEXT_LEN_MASK)
|
|
||||||
{
|
|
||||||
bes_err("MISS 1\n");
|
|
||||||
rx = 1;
|
|
||||||
goto test;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
if (!status && hw_priv->hw_bufs_used) {
|
|
||||||
unsigned long timestamp = jiffies;
|
|
||||||
long timeout;
|
|
||||||
bool pending = false;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
wiphy_warn(hw_priv->hw->wiphy, "Missed interrupt?\n");
|
|
||||||
rx = 1;
|
|
||||||
|
|
||||||
/* Get a timestamp of "oldest" frame */
|
|
||||||
for (i = 0; i < 4; ++i)
|
|
||||||
pending |= bes2600_queue_get_xmit_timestamp(
|
|
||||||
&hw_priv->tx_queue[i],
|
|
||||||
×tamp, -1,
|
|
||||||
hw_priv->pending_frame_id);
|
|
||||||
|
|
||||||
/* Check if frame transmission is timed out.
|
|
||||||
* Add an extra second with respect to possible
|
|
||||||
* interrupt loss. */
|
|
||||||
timeout = timestamp +
|
|
||||||
WSM_CMD_LAST_CHANCE_TIMEOUT +
|
|
||||||
1 * HZ -
|
|
||||||
jiffies;
|
|
||||||
|
|
||||||
/* And terminate BH tread if the frame is "stuck" */
|
|
||||||
if (pending && timeout < 0) {
|
|
||||||
//wiphy_warn(priv->hw->wiphy,
|
|
||||||
// "Timeout waiting for TX confirm.\n");
|
|
||||||
bes_devel("bes2600_bh: Timeout waiting for TX confirm.\n");
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
#if defined(CONFIG_BES2600_DUMP_ON_ERROR)
|
|
||||||
BUG_ON(1);
|
|
||||||
#endif /* CONFIG_BES2600_DUMP_ON_ERROR */
|
|
||||||
} else if (!status) {
|
|
||||||
if (!hw_priv->device_can_sleep
|
|
||||||
&& !atomic_read(&hw_priv->recent_scan)) {
|
|
||||||
bes_devel("[BH] Device wakedown. Timeout.\n");
|
|
||||||
#ifndef FPGA_SETUP
|
|
||||||
WARN_ON(bes2600_reg_write_16(hw_priv,
|
|
||||||
ST90TDS_CONTROL_REG_ID, 0));
|
|
||||||
hw_priv->device_can_sleep = true;
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
continue;
|
|
||||||
} else if (suspend) {
|
|
||||||
bes_devel("[BH] Device suspend.\n");
|
|
||||||
powersave_enabled = 1;
|
|
||||||
spin_lock(&hw_priv->vif_list_lock);
|
|
||||||
bes2600_for_each_vif(hw_priv, priv, i) {
|
|
||||||
#ifdef P2P_MULTIVIF
|
|
||||||
if ((i = (CW12XX_MAX_VIFS - 1)) || !priv)
|
|
||||||
#else
|
|
||||||
if (!priv)
|
|
||||||
#endif
|
|
||||||
continue;
|
|
||||||
powersave_enabled &= !!priv->powersave_enabled;
|
|
||||||
}
|
|
||||||
spin_unlock(&hw_priv->vif_list_lock);
|
|
||||||
if (powersave_enabled) {
|
|
||||||
bes_devel("[BH] No Device wakedown. Suspend.\n");
|
|
||||||
#ifndef FPGA_SETUP
|
|
||||||
WARN_ON(bes2600_reg_write_16(hw_priv,
|
|
||||||
ST90TDS_CONTROL_REG_ID, 0));
|
|
||||||
hw_priv->device_can_sleep = true;
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
atomic_set(&hw_priv->bh_suspend, BES2600_BH_SUSPENDED);
|
|
||||||
wake_up(&hw_priv->bh_evt_wq);
|
|
||||||
status = wait_event_interruptible(hw_priv->bh_wq,
|
|
||||||
BES2600_BH_RESUME == atomic_read(
|
|
||||||
&hw_priv->bh_suspend));
|
|
||||||
if (status < 0) {
|
|
||||||
wiphy_err(hw_priv->hw->wiphy,
|
|
||||||
"%s: Failed to wait for resume: %ld.\n",
|
|
||||||
__func__, status);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
bes_devel("[BH] Device resume.\n");
|
|
||||||
atomic_set(&hw_priv->bh_suspend, BES2600_BH_RESUMED);
|
|
||||||
wake_up(&hw_priv->bh_evt_wq);
|
|
||||||
atomic_add(1, &hw_priv->bh_rx);
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
|
|
||||||
test:
|
|
||||||
tx += pending_tx;
|
|
||||||
pending_tx = 0;
|
|
||||||
|
|
||||||
if (rx) {
|
|
||||||
size_t alloc_len;
|
|
||||||
u8 *data;
|
|
||||||
|
|
||||||
#ifdef INTERRUPT_WORKAROUND
|
|
||||||
if(!(ctrl_reg & ST90TDS_CONT_NEXT_LEN_MASK))
|
|
||||||
#endif
|
|
||||||
if (WARN_ON(bes2600_bh_read_ctrl_reg(
|
|
||||||
hw_priv, &ctrl_reg)))
|
|
||||||
break;
|
|
||||||
rx:
|
|
||||||
read_len = (ctrl_reg & ST90TDS_CONT_NEXT_LEN_MASK) * 2;
|
|
||||||
if (!read_len) {
|
|
||||||
rx_burst = 0;
|
|
||||||
goto tx;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (WARN_ON((read_len < sizeof(struct wsm_hdr)) ||
|
|
||||||
(read_len > EFFECTIVE_BUF_SIZE))) {
|
|
||||||
bes_devel("Invalid read len: %d", read_len);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Add SIZE of PIGGYBACK reg (CONTROL Reg)
|
|
||||||
* to the NEXT Message length + 2 Bytes for SKB */
|
|
||||||
read_len = read_len + 2;
|
|
||||||
|
|
||||||
#if defined(CONFIG_BES2600_NON_POWER_OF_TWO_BLOCKSIZES)
|
|
||||||
alloc_len = hw_priv->sbus_ops->align_size(
|
|
||||||
hw_priv->sbus_priv, read_len);
|
|
||||||
#else /* CONFIG_BES2600_NON_POWER_OF_TWO_BLOCKSIZES */
|
|
||||||
/* Platform's SDIO workaround */
|
|
||||||
alloc_len = read_len & ~(SDIO_BLOCK_SIZE - 1);
|
|
||||||
if (read_len & (SDIO_BLOCK_SIZE - 1))
|
|
||||||
alloc_len += SDIO_BLOCK_SIZE;
|
|
||||||
#endif /* CONFIG_BES2600_NON_POWER_OF_TWO_BLOCKSIZES */
|
|
||||||
|
|
||||||
/* Check if not exceeding BES2600 capabilities */
|
|
||||||
if (WARN_ON_ONCE(alloc_len > EFFECTIVE_BUF_SIZE))
|
|
||||||
bes_devel("Read aligned len: %d\n", alloc_len);
|
|
||||||
|
|
||||||
skb_rx = bes2600_get_skb(hw_priv, alloc_len);
|
|
||||||
if (WARN_ON(!skb_rx))
|
|
||||||
break;
|
|
||||||
|
|
||||||
skb_trim(skb_rx, 0);
|
|
||||||
skb_put(skb_rx, read_len);
|
|
||||||
data = skb_rx->data;
|
|
||||||
if (WARN_ON(!data))
|
|
||||||
break;
|
|
||||||
|
|
||||||
if (WARN_ON(bes2600_data_read(hw_priv, data, alloc_len)))
|
|
||||||
break;
|
|
||||||
|
|
||||||
/* Piggyback */
|
|
||||||
ctrl_reg = __le16_to_cpu(
|
|
||||||
((__le16 *)data)[alloc_len / 2 - 1]);
|
|
||||||
|
|
||||||
wsm = (struct wsm_hdr *)data;
|
|
||||||
wsm_len = __le32_to_cpu(wsm->len);
|
|
||||||
if (WARN_ON(wsm_len > read_len))
|
|
||||||
break;
|
|
||||||
|
|
||||||
#if defined(CONFIG_BES2600_WSM_DUMPS)
|
|
||||||
if (unlikely(hw_priv->wsm_enable_wsm_dumps)) {
|
|
||||||
u16 msgid, ifid;
|
|
||||||
u16 *p = (u16 *)data;
|
|
||||||
msgid = (*(p + 1)) & 0xC3F;
|
|
||||||
ifid = (*(p + 1)) >> 6;
|
|
||||||
ifid &= 0xF;
|
|
||||||
bes_devel("[DUMP] <<< msgid 0x%.4X ifid %d len %d\n", msgid, ifid, *p);
|
|
||||||
print_hex_dump(KERN_DEBUG, "<-- ", DUMP_PREFIX_NONE, data, min(wsm_len, wsm_dump_max));
|
|
||||||
}
|
|
||||||
#endif /* CONFIG_BES2600_WSM_DUMPS */
|
|
||||||
|
|
||||||
wsm_id = __le32_to_cpu(wsm->id) & 0xFFF;
|
|
||||||
wsm_seq = (__le32_to_cpu(wsm->id) >> 13) & 7;
|
|
||||||
|
|
||||||
skb_trim(skb_rx, wsm_len);
|
|
||||||
|
|
||||||
if (unlikely(wsm_id == 0x0800)) {
|
|
||||||
wsm_handle_exception(hw_priv,
|
|
||||||
&data[sizeof(*wsm)],
|
|
||||||
wsm_len - sizeof(*wsm));
|
|
||||||
break;
|
|
||||||
} else if (unlikely(!rx_resync)) {
|
|
||||||
if (WARN_ON(wsm_seq != hw_priv->wsm_rx_seq)) {
|
|
||||||
#if defined(CONFIG_BES2600_DUMP_ON_ERROR)
|
|
||||||
BUG_ON(1);
|
|
||||||
#endif /* CONFIG_BES2600_DUMP_ON_ERROR */
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
hw_priv->wsm_rx_seq = (wsm_seq + 1) & 7;
|
|
||||||
rx_resync = 0;
|
|
||||||
|
|
||||||
if (wsm_id & 0x0400) {
|
|
||||||
int rc = wsm_release_tx_buffer(hw_priv, 1);
|
|
||||||
if (WARN_ON(rc < 0))
|
|
||||||
break;
|
|
||||||
else if (rc > 0)
|
|
||||||
tx = 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* bes2600_wsm_rx takes care on SKB livetime */
|
|
||||||
if (WARN_ON(wsm_handle_rx(hw_priv, wsm_id, wsm,
|
|
||||||
&skb_rx)))
|
|
||||||
break;
|
|
||||||
|
|
||||||
if (skb_rx) {
|
|
||||||
bes2600_put_skb(hw_priv, skb_rx);
|
|
||||||
skb_rx = NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
read_len = 0;
|
|
||||||
|
|
||||||
if (rx_burst) {
|
|
||||||
bes2600_debug_rx_burst(hw_priv);
|
|
||||||
--rx_burst;
|
|
||||||
goto rx;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
tx:
|
|
||||||
BUG_ON(hw_priv->hw_bufs_used > hw_priv->wsm_caps.numInpChBufs);
|
|
||||||
tx_burst = hw_priv->wsm_caps.numInpChBufs -
|
|
||||||
hw_priv->hw_bufs_used;
|
|
||||||
tx_allowed = tx_burst > 0;
|
|
||||||
if (tx && tx_allowed) {
|
|
||||||
size_t tx_len;
|
|
||||||
u8 *data;
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
if (hw_priv->device_can_sleep) {
|
|
||||||
ret = bes2600_device_wakeup(hw_priv);
|
|
||||||
if (WARN_ON(ret < 0))
|
|
||||||
break;
|
|
||||||
else if (ret)
|
|
||||||
hw_priv->device_can_sleep = false;
|
|
||||||
else {
|
|
||||||
/* Wait for "awake" interrupt */
|
|
||||||
pending_tx = tx;
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
wsm_alloc_tx_buffer(hw_priv);
|
|
||||||
ret = wsm_get_tx(hw_priv, &data, &tx_len, &tx_burst,
|
|
||||||
&vif_selected);
|
|
||||||
if (ret <= 0) {
|
|
||||||
wsm_release_tx_buffer(hw_priv, 1);
|
|
||||||
if (WARN_ON(ret < 0))
|
|
||||||
break;
|
|
||||||
} else {
|
|
||||||
wsm = (struct wsm_hdr *)data;
|
|
||||||
BUG_ON(tx_len < sizeof(*wsm));
|
|
||||||
BUG_ON(__le32_to_cpu(wsm->len) != tx_len);
|
|
||||||
|
|
||||||
#if 0 /* count is not implemented */
|
|
||||||
if (ret > 1)
|
|
||||||
atomic_add(1, &hw_priv->bh_tx);
|
|
||||||
#else
|
|
||||||
atomic_add(1, &hw_priv->bh_tx);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#if defined(CONFIG_BES2600_NON_POWER_OF_TWO_BLOCKSIZES)
|
|
||||||
if (tx_len <= 8)
|
|
||||||
tx_len = 16;
|
|
||||||
tx_len = hw_priv->sbus_ops->align_size(
|
|
||||||
hw_priv->sbus_priv, tx_len);
|
|
||||||
#else /* CONFIG_BES2600_NON_POWER_OF_TWO_BLOCKSIZES */
|
|
||||||
/* HACK!!! Platform limitation.
|
|
||||||
* It is also supported by upper layer:
|
|
||||||
* there is always enough space at the
|
|
||||||
* end of the buffer. */
|
|
||||||
if (tx_len & (SDIO_BLOCK_SIZE - 1)) {
|
|
||||||
tx_len &= ~(SDIO_BLOCK_SIZE - 1);
|
|
||||||
tx_len += SDIO_BLOCK_SIZE;
|
|
||||||
}
|
|
||||||
#endif /* CONFIG_BES2600_NON_POWER_OF_TWO_BLOCKSIZES */
|
|
||||||
|
|
||||||
/* Check if not exceeding BES2600
|
|
||||||
capabilities */
|
|
||||||
if (WARN_ON_ONCE(tx_len > EFFECTIVE_BUF_SIZE))
|
|
||||||
bes_devel("Write aligned len: %d\n", tx_len);
|
|
||||||
|
|
||||||
wsm->id &= __cpu_to_le32(
|
|
||||||
~WSM_TX_SEQ(WSM_TX_SEQ_MAX));
|
|
||||||
wsm->id |= cpu_to_le32(WSM_TX_SEQ(
|
|
||||||
hw_priv->wsm_tx_seq));
|
|
||||||
|
|
||||||
if (WARN_ON(bes2600_data_write(hw_priv,
|
|
||||||
data, tx_len))) {
|
|
||||||
wsm_release_tx_buffer(hw_priv, 1);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (vif_selected != -1) {
|
|
||||||
hw_priv->hw_bufs_used_vif[
|
|
||||||
vif_selected]++;
|
|
||||||
}
|
|
||||||
|
|
||||||
#if defined(CONFIG_BES2600_WSM_DUMPS)
|
|
||||||
if (unlikely(hw_priv->wsm_enable_wsm_dumps)) {
|
|
||||||
u16 msgid, ifid;
|
|
||||||
u16 *p = (u16 *)data;
|
|
||||||
msgid = (*(p + 1)) & 0x3F;
|
|
||||||
ifid = (*(p + 1)) >> 6;
|
|
||||||
ifid &= 0xF;
|
|
||||||
if (msgid == 0x0006)
|
|
||||||
bes_devel("[DUMP] >>> msgid 0x%.4X ifid %d len %d MIB 0x%.4X\n", msgid, ifid, *p, *(p + 2));
|
|
||||||
else
|
|
||||||
bes_devel("[DUMP] >>> msgid 0x%.4X ifid %d len %d\n", msgid, ifid, *p);
|
|
||||||
print_hex_dump(KERN_DEBUG, "--> ", DUMP_PREFIX_NONE, data, min(__le32_to_cpu(wsm->len), wsm_dump_max));
|
|
||||||
}
|
|
||||||
#endif /* CONFIG_BES2600_WSM_DUMPS */
|
|
||||||
|
|
||||||
wsm_txed(hw_priv, data);
|
|
||||||
hw_priv->wsm_tx_seq = (hw_priv->wsm_tx_seq + 1)
|
|
||||||
& WSM_TX_SEQ_MAX;
|
|
||||||
|
|
||||||
if (tx_burst > 1) {
|
|
||||||
bes2600_debug_tx_burst(hw_priv);
|
|
||||||
++rx_burst;
|
|
||||||
goto tx;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
if (ctrl_reg & ST90TDS_CONT_NEXT_LEN_MASK)
|
|
||||||
goto rx;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (skb_rx) {
|
|
||||||
bes2600_put_skb(hw_priv, skb_rx);
|
|
||||||
skb_rx = NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
if (!term) {
|
|
||||||
bes_devel("[BH] Fatal error, exitting.\n");
|
|
||||||
#if defined(CONFIG_BES2600_DUMP_ON_ERROR)
|
|
||||||
BUG_ON(1);
|
|
||||||
#endif /* CONFIG_BES2600_DUMP_ON_ERROR */
|
|
||||||
hw_priv->bh_error = 1;
|
|
||||||
#if defined(CONFIG_BES2600_USE_STE_EXTENSIONS)
|
|
||||||
spin_lock(&hw_priv->vif_list_lock);
|
|
||||||
bes2600_for_each_vif(hw_priv, priv, i) {
|
|
||||||
if (!priv)
|
|
||||||
continue;
|
|
||||||
ieee80211_driver_hang_notify(priv->vif, GFP_KERNEL);
|
|
||||||
}
|
|
||||||
spin_unlock(&hw_priv->vif_list_lock);
|
|
||||||
bes2600_pm_stay_awake(&hw_priv->pm_state, 3*HZ);
|
|
||||||
#endif
|
|
||||||
/* TODO: schedule_work(recovery) */
|
|
||||||
#ifndef HAS_PUT_TASK_STRUCT
|
|
||||||
/* The only reason of having this stupid code here is
|
|
||||||
* that __put_task_struct is not exported by kernel. */
|
|
||||||
for (;;) {
|
|
||||||
int status = wait_event_interruptible(hw_priv->bh_wq, ({
|
|
||||||
term = atomic_xchg(&hw_priv->bh_term, 0);
|
|
||||||
(term);
|
|
||||||
}));
|
|
||||||
|
|
||||||
if (status || term)
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
#else
|
|
||||||
|
|
||||||
extern int bes2600_bh_read_ctrl_reg(struct bes2600_common *priv, u32 *ctrl_reg);
|
extern int bes2600_bh_read_ctrl_reg(struct bes2600_common *priv, u32 *ctrl_reg);
|
||||||
|
|
||||||
@@ -958,6 +412,119 @@ static void bes2600_bh_parse_wakeup_event(struct bes2600_common *hw_priv, struct
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Direct-deliver an RX SKB into the WSM/mac80211 stack.
|
||||||
|
*
|
||||||
|
* Patch C v3 (no-relay architecture, matches cw1200): the bh thread
|
||||||
|
* calls bes2600_sdio_read_rx_batch which calls
|
||||||
|
* bes2600_sdio_extract_packets which calls THIS function per parsed
|
||||||
|
* SKB. No rx_queue, no sdio_rx_work, no inter-thread handoff.
|
||||||
|
*
|
||||||
|
* Single-writer-from-bh invariant on hw_priv->hw_bufs_used,
|
||||||
|
* hw_priv->hw_bufs_used_vif[] and hw_priv->wsm_tx_pending[] is
|
||||||
|
* preserved BY CONSTRUCTION — there is now only one writer (the bh
|
||||||
|
* thread itself), same as cw1200's design. No atomic_t conversion
|
||||||
|
* needed.
|
||||||
|
*
|
||||||
|
* Contract:
|
||||||
|
* - process context, sleepable. wsm_handle_rx (wsm.c, EXPORT_SYMBOL)
|
||||||
|
* acquires wsm_cmd.lock and may sleep on wait_event_timeout.
|
||||||
|
* - caller holds no bes2600 spinlock. bes2600_sdio_unlock(self) is
|
||||||
|
* called inside read_rx_batch before extract_packets is invoked.
|
||||||
|
* - SKB ownership: function frees on every path (success + error).
|
||||||
|
* - No need to wake the bh thread on TX-confirm — we ARE the bh
|
||||||
|
* thread; tx_burst is signalled by returning *tx_out = 1 to the
|
||||||
|
* caller (bh_rx_helper), which propagates it to bh's outer loop.
|
||||||
|
*/
|
||||||
|
int bes2600_bh_handle_rx_skb(struct bes2600_common *priv, struct sk_buff *skb)
|
||||||
|
{
|
||||||
|
struct wsm_hdr *wsm;
|
||||||
|
size_t wsm_len;
|
||||||
|
u16 wsm_id;
|
||||||
|
u8 wsm_seq;
|
||||||
|
int tx = 0;
|
||||||
|
u32 confirm_label = 0x0;
|
||||||
|
|
||||||
|
if (!skb)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
wsm = (struct wsm_hdr *)skb->data;
|
||||||
|
wsm_len = __le16_to_cpu(wsm->len);
|
||||||
|
if (WARN_ON(wsm_len > skb->len)) {
|
||||||
|
bes_err("wsm_len err %d %d\n", (int)wsm_len, (int)skb->len);
|
||||||
|
dev_kfree_skb(skb);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (priv->wsm_enable_wsm_dumps)
|
||||||
|
print_hex_dump(KERN_DEBUG, "<-- ", DUMP_PREFIX_NONE, 16, 1,
|
||||||
|
skb->data, wsm_len, false);
|
||||||
|
|
||||||
|
wsm_id = __le16_to_cpu(wsm->id) & 0xFFF;
|
||||||
|
wsm_seq = (__le16_to_cpu(wsm->id) >> 13) & 7;
|
||||||
|
bes_devel("bes2600_bh_handle_rx_skb wsm_id:0x%04x seq:%d\n",
|
||||||
|
wsm_id, wsm_seq);
|
||||||
|
|
||||||
|
skb_trim(skb, wsm_len);
|
||||||
|
|
||||||
|
if (wsm_id == 0x0800) {
|
||||||
|
wsm_handle_exception(priv,
|
||||||
|
&skb->data[sizeof(*wsm)],
|
||||||
|
wsm_len - sizeof(*wsm));
|
||||||
|
bes_err("wsm exception\n");
|
||||||
|
dev_kfree_skb(skb);
|
||||||
|
return -1;
|
||||||
|
} else if ((wsm_seq != priv->wsm_rx_seq[WSM_TXRX_SEQ_IDX(wsm_id)])) {
|
||||||
|
bes_err("seq error! %u. %u. 0x%x.", wsm_seq,
|
||||||
|
priv->wsm_rx_seq[WSM_TXRX_SEQ_IDX(wsm_id)], wsm_id);
|
||||||
|
dev_kfree_skb(skb);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
bes2600_bh_parse_wakeup_event(priv, skb);
|
||||||
|
|
||||||
|
priv->wsm_rx_seq[WSM_TXRX_SEQ_IDX(wsm_id)] = (wsm_seq + 1) & 7;
|
||||||
|
|
||||||
|
if (IS_DRIVER_TO_MCU_CMD(wsm_id))
|
||||||
|
confirm_label = __le32_to_cpu(((struct wsm_mcu_hdr *)wsm)->handle_label);
|
||||||
|
|
||||||
|
if (WSM_CONFIRM_CONDITION(wsm_id, confirm_label)) {
|
||||||
|
int rc = wsm_release_tx_buffer(priv, 1);
|
||||||
|
bes2600_bh_dec_pending_count(priv, WSM_TXRX_SEQ_IDX(wsm->id));
|
||||||
|
|
||||||
|
if (rc < 0) {
|
||||||
|
bes_err("wsm_release_tx_buffer failed: %d\n", rc);
|
||||||
|
dev_kfree_skb(skb);
|
||||||
|
return rc;
|
||||||
|
} else if (rc > 0) {
|
||||||
|
tx = 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* wsm_handle_rx takes care of SKB lifetime: zeroes *skb_p if consumed. */
|
||||||
|
if (wsm_handle_rx(priv, wsm_id, wsm, &skb)) {
|
||||||
|
bes_err("wsm_handle_rx failed (id=0x%04x)\n", wsm_id);
|
||||||
|
if (skb)
|
||||||
|
dev_kfree_skb(skb);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (skb)
|
||||||
|
dev_kfree_skb(skb);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Signal "tx side has new headroom" via atomic so the bh outer
|
||||||
|
* loop's wait_event predicate notices on its next wait. No
|
||||||
|
* cross-thread wake needed because we are the bh thread; the
|
||||||
|
* outer loop will pick this up after read_rx_batch returns.
|
||||||
|
*/
|
||||||
|
if (tx)
|
||||||
|
atomic_inc(&priv->bh_tx);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL(bes2600_bh_handle_rx_skb);
|
||||||
|
|
||||||
static int bes2600_bh_rx_helper(struct bes2600_common *priv, int *tx)
|
static int bes2600_bh_rx_helper(struct bes2600_common *priv, int *tx)
|
||||||
{
|
{
|
||||||
struct sk_buff *skb = NULL;
|
struct sk_buff *skb = NULL;
|
||||||
@@ -969,10 +536,18 @@ static int bes2600_bh_rx_helper(struct bes2600_common *priv, int *tx)
|
|||||||
u32 confirm_label = 0x0; /* wsm to mcu cmd cnfirm label */
|
u32 confirm_label = 0x0; /* wsm to mcu cmd cnfirm label */
|
||||||
|
|
||||||
#if defined(BES_SDIO_RX_MULTIPLE_ENABLE)
|
#if defined(BES_SDIO_RX_MULTIPLE_ENABLE)
|
||||||
skb = (struct sk_buff *)priv->sbus_ops->pipe_read(priv->sbus_priv);
|
/*
|
||||||
if (!skb)
|
* Patch C v3: the bh thread does the SDIO read inline via
|
||||||
|
* sbus_ops->bus_rx_batch. bes2600_sdio_read_rx_batch reads the
|
||||||
|
* multi-RX coalesced frames out of the chip and delivers each
|
||||||
|
* one inline via bes2600_bh_handle_rx_skb (no rx_queue, no
|
||||||
|
* pipe_read, no inter-thread handoff). Return value: 0 on
|
||||||
|
* success (bh outer loop will check whether to continue),
|
||||||
|
* negative on read error.
|
||||||
|
*/
|
||||||
|
if (priv->sbus_ops->bus_rx_batch)
|
||||||
|
return priv->sbus_ops->bus_rx_batch(priv->sbus_priv);
|
||||||
return 0;
|
return 0;
|
||||||
rx = 1; // always consider rx pipe not empty
|
|
||||||
#else
|
#else
|
||||||
u32 ctrl_reg = 0;
|
u32 ctrl_reg = 0;
|
||||||
size_t read_len = 0;
|
size_t read_len = 0;
|
||||||
@@ -1134,7 +709,7 @@ static int bes2600_bh_tx_helper(struct bes2600_common *hw_priv,
|
|||||||
tx_len += 4;
|
tx_len += 4;
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
atomic_add(1, &hw_priv->bh_tx);
|
atomic_inc(&hw_priv->bh_tx);
|
||||||
|
|
||||||
tx_len = hw_priv->sbus_ops->align_size(
|
tx_len = hw_priv->sbus_ops->align_size(
|
||||||
hw_priv->sbus_priv, tx_len);
|
hw_priv->sbus_priv, tx_len);
|
||||||
@@ -1435,7 +1010,7 @@ static int bes2600_bh(void *arg)
|
|||||||
bes_devel("[BH] Device resume.\n");
|
bes_devel("[BH] Device resume.\n");
|
||||||
atomic_set(&hw_priv->bh_suspend, BES2600_BH_RESUMED);
|
atomic_set(&hw_priv->bh_suspend, BES2600_BH_RESUMED);
|
||||||
wake_up(&hw_priv->bh_evt_wq);
|
wake_up(&hw_priv->bh_evt_wq);
|
||||||
atomic_add(1, &hw_priv->bh_rx);
|
atomic_inc(&hw_priv->bh_rx);
|
||||||
goto done;
|
goto done;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -1471,7 +1046,15 @@ static int bes2600_bh(void *arg)
|
|||||||
|
|
||||||
tx = 0;
|
tx = 0;
|
||||||
|
|
||||||
BUG_ON(hw_priv->hw_bufs_used > hw_priv->wsm_caps.numInpChBufs);
|
/*
|
||||||
|
* Patch H: BUG_ON -> WARN_ON_ONCE in the steady-state
|
||||||
|
* hot path. The original BUG_ON ran every bh-loop
|
||||||
|
* iteration; tripping it on a bookkeeping bug locks
|
||||||
|
* the kernel up during normal operation, which is
|
||||||
|
* the wrong response. WARN_ON_ONCE surfaces the
|
||||||
|
* issue without taking the system down.
|
||||||
|
*/
|
||||||
|
WARN_ON_ONCE(hw_priv->hw_bufs_used > hw_priv->wsm_caps.numInpChBufs);
|
||||||
tx_burst = hw_priv->wsm_caps.numInpChBufs - hw_priv->hw_bufs_used;
|
tx_burst = hw_priv->wsm_caps.numInpChBufs - hw_priv->hw_bufs_used;
|
||||||
tx_allowed = tx_burst > 0;
|
tx_allowed = tx_burst > 0;
|
||||||
|
|
||||||
@@ -1515,18 +1098,19 @@ static int bes2600_bh(void *arg)
|
|||||||
goto tx;
|
goto tx;
|
||||||
|
|
||||||
done:
|
done:
|
||||||
/* Re-enable device interrupts */
|
/*
|
||||||
//hw_priv->sbus_ops->lock(hw_priv->sbus_priv);
|
* Patch H: dropped the dead `__bes2600_irq_enable(1)` /
|
||||||
//__bes2600_irq_enable(1);
|
* `asm volatile("nop")` placeholder that used to sit here.
|
||||||
//hw_priv->sbus_ops->unlock(hw_priv->sbus_priv);
|
* `__bes2600_irq_enable()` is a stub that returns 0 on
|
||||||
asm volatile ("nop");
|
* bes2600 silicon — the IRQ is managed by sdio_claim_irq
|
||||||
|
* and chip-side firmware, not by a driver-side enable bit.
|
||||||
|
* (cw1200 inherited the function from a different chip
|
||||||
|
* shape; bes2600 kept the stub but the call sites are
|
||||||
|
* meaningless.)
|
||||||
|
*/
|
||||||
|
;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Explicitly disable device interrupts */
|
|
||||||
hw_priv->sbus_ops->lock(hw_priv->sbus_priv);
|
|
||||||
__bes2600_irq_enable(0);
|
|
||||||
hw_priv->sbus_ops->unlock(hw_priv->sbus_priv);
|
|
||||||
|
|
||||||
if (!term) {
|
if (!term) {
|
||||||
bes_err("[BH] Fatal error, exiting.\n");
|
bes_err("[BH] Fatal error, exiting.\n");
|
||||||
sdio_work_debug(hw_priv->sbus_priv);
|
sdio_work_debug(hw_priv->sbus_priv);
|
||||||
@@ -1535,4 +1119,3 @@ static int bes2600_bh(void *arg)
|
|||||||
}
|
}
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
#endif
|
|
||||||
|
|||||||
+15
-6
@@ -1,12 +1,12 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Device handling thread interface for mac80211 BES2600 drivers
|
* Bottom-half thread interface for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef BES2600_BH_H
|
#ifndef BES2600_BH_H
|
||||||
@@ -39,6 +39,15 @@ int wsm_release_vif_tx_buffer(struct bes2600_common *hw_priv, int if_id,
|
|||||||
int bes2600_bh_sw_process(struct bes2600_common *hw_priv,
|
int bes2600_bh_sw_process(struct bes2600_common *hw_priv,
|
||||||
struct wsm_tx_confirm *tx_confirm);
|
struct wsm_tx_confirm *tx_confirm);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Direct-deliver an RX SKB into the WSM/mac80211 stack from the bh thread.
|
||||||
|
* Called by bes2600_sdio_extract_packets per RX frame, no queueing.
|
||||||
|
* Process context, sleepable, caller holds no bes2600 spinlock.
|
||||||
|
* Function frees skb on every path. See bh.c for full contract.
|
||||||
|
*/
|
||||||
|
int bes2600_bh_handle_rx_skb(struct bes2600_common *hw_priv,
|
||||||
|
struct sk_buff *skb);
|
||||||
|
|
||||||
void bes2600_bh_inc_pending_count(struct bes2600_common *hw_priv, int idx);
|
void bes2600_bh_inc_pending_count(struct bes2600_common *hw_priv, int idx);
|
||||||
void bes2600_bh_dec_pending_count(struct bes2600_common *hw_priv, int idx);
|
void bes2600_bh_dec_pending_count(struct bes2600_common *hw_priv, int idx);
|
||||||
|
|
||||||
|
|||||||
+12
-9
@@ -1,12 +1,12 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Debugging interface for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
@@ -110,17 +110,20 @@ static int bes2600_status_show_common(struct seq_file *seq, void *v)
|
|||||||
int ba_cnt, ba_acc, ba_cnt_rx, ba_acc_rx, ba_avg = 0, ba_avg_rx = 0;
|
int ba_cnt, ba_acc, ba_cnt_rx, ba_acc_rx, ba_avg = 0, ba_avg_rx = 0;
|
||||||
bool ba_ena;
|
bool ba_ena;
|
||||||
|
|
||||||
spin_lock_bh(&hw_priv->ba_lock);
|
/*
|
||||||
|
* Patch D: ba_lock removed. hw_priv->debug->ba_* are written only
|
||||||
|
* by the timer callback (single writer); reading without a lock is
|
||||||
|
* fine for stats. ba_ena is atomic_t.
|
||||||
|
*/
|
||||||
ba_cnt = hw_priv->debug->ba_cnt;
|
ba_cnt = hw_priv->debug->ba_cnt;
|
||||||
ba_acc = hw_priv->debug->ba_acc;
|
ba_acc = hw_priv->debug->ba_acc;
|
||||||
ba_cnt_rx = hw_priv->debug->ba_cnt_rx;
|
ba_cnt_rx = hw_priv->debug->ba_cnt_rx;
|
||||||
ba_acc_rx = hw_priv->debug->ba_acc_rx;
|
ba_acc_rx = hw_priv->debug->ba_acc_rx;
|
||||||
ba_ena = hw_priv->ba_ena;
|
ba_ena = !!atomic_read(&hw_priv->ba_ena);
|
||||||
if (ba_cnt)
|
if (ba_cnt)
|
||||||
ba_avg = ba_acc / ba_cnt;
|
ba_avg = ba_acc / ba_cnt;
|
||||||
if (ba_cnt_rx)
|
if (ba_cnt_rx)
|
||||||
ba_avg_rx = ba_acc_rx / ba_cnt_rx;
|
ba_avg_rx = ba_acc_rx / ba_cnt_rx;
|
||||||
spin_unlock_bh(&hw_priv->ba_lock);
|
|
||||||
|
|
||||||
seq_puts(seq, "BES2600 Wireless LAN driver status\n");
|
seq_puts(seq, "BES2600 Wireless LAN driver status\n");
|
||||||
seq_printf(seq, "Hardware: %d.%d\n",
|
seq_printf(seq, "Hardware: %d.%d\n",
|
||||||
|
|||||||
+6
-6
@@ -1,12 +1,12 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* DebugFS code for BES2600 mac80211 driver
|
* Debugging interface for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2011, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef BES2600_DEBUG_H_INCLUDED
|
#ifndef BES2600_DEBUG_H_INCLUDED
|
||||||
|
|||||||
+3
-6
@@ -1,12 +1,9 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* BT/WiFi coexistence (ePTA) for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#include <linux/types.h>
|
#include <linux/types.h>
|
||||||
#include <linux/version.h>
|
#include <linux/version.h>
|
||||||
|
|||||||
+3
-6
@@ -1,12 +1,9 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* BT/WiFi coexistence interface for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#ifndef __EPTA_COEX_H__
|
#ifndef __EPTA_COEX_H__
|
||||||
#define __EPTA_COEX_H__
|
#define __EPTA_COEX_H__
|
||||||
|
|||||||
@@ -1,12 +1,9 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* BT/WiFi coexistence request handling
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#include <linux/types.h>
|
#include <linux/types.h>
|
||||||
#include <linux/kernel.h>
|
#include <linux/kernel.h>
|
||||||
|
|||||||
@@ -1,12 +1,9 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* BT/WiFi coexistence request interface
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#ifndef EPTA_REQUEST_H
|
#ifndef EPTA_REQUEST_H
|
||||||
#define EPTA_REQUEST_H
|
#define EPTA_REQUEST_H
|
||||||
|
|||||||
+6
-6
@@ -1,12 +1,12 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Firmware I/O for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/init.h>
|
#include <linux/init.h>
|
||||||
|
|||||||
+6
-6
@@ -1,12 +1,12 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Firmware I/O interface for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#ifndef FWIO_H_INCLUDED
|
#ifndef FWIO_H_INCLUDED
|
||||||
#define FWIO_H_INCLUDED
|
#define FWIO_H_INCLUDED
|
||||||
|
|||||||
+3
-6
@@ -1,12 +1,9 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* HT-related code for BES2600 driver
|
* HT capability config for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef BES2600_HT_H_INCLUDED
|
#ifndef BES2600_HT_H_INCLUDED
|
||||||
|
|||||||
+13
-10
@@ -1,12 +1,12 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Low-level device IO routines for BES2600 drivers
|
* Low-level device I/O for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/types.h>
|
#include <linux/types.h>
|
||||||
@@ -324,7 +324,10 @@ out:
|
|||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
int __bes2600_irq_enable(int enable)
|
/*
|
||||||
{
|
* Patch H: __bes2600_irq_enable stub removed. It was a no-op
|
||||||
return 0;
|
* (always returned 0) inherited from cw1200 where the analogous
|
||||||
}
|
* function manipulates the chip's IRQ-enable register. bes2600
|
||||||
|
* silicon manages SDIO IRQ via sdio_claim_irq and chip-side
|
||||||
|
* firmware — there is no driver-side enable register to write.
|
||||||
|
*/
|
||||||
|
|||||||
+5
-10
@@ -1,17 +1,12 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Low-level API for mac80211 BES2600 drivers
|
* Low-level device I/O interface for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
*
|
*
|
||||||
* Based on:
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* UMAC BES2600 driver which is
|
|
||||||
* Copyright (c) 2010, Bestechnic
|
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef BES2600_HWIO_H_INCLUDED
|
#ifndef BES2600_HWIO_H_INCLUDED
|
||||||
|
|||||||
+4
-8
@@ -1,13 +1,9 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* mac80211 glue code for mac80211 BES2600 drivers
|
* ITP (in-band test mode) for BES2600
|
||||||
* ITP code
|
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
@@ -570,7 +566,7 @@ int bes2600_itp_get_tx(struct bes2600_common *priv, u8 **data,
|
|||||||
*burst = 2;
|
*burst = 2;
|
||||||
atomic_set(&priv->bh_tx, 1);
|
atomic_set(&priv->bh_tx, 1);
|
||||||
ktime_get_ts(&itp->last_sent);
|
ktime_get_ts(&itp->last_sent);
|
||||||
atomic_add(1, &itp->awaiting_confirm);
|
atomic_inc(&itp->awaiting_confirm);
|
||||||
spin_unlock_bh(&itp->tx_lock);
|
spin_unlock_bh(&itp->tx_lock);
|
||||||
return 1;
|
return 1;
|
||||||
|
|
||||||
|
|||||||
+3
-6
@@ -1,12 +1,9 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* ITP code for BES2600 mac80211 driver
|
* ITP interface for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2011, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef BES2600_ITP_H_INCLUDED
|
#ifndef BES2600_ITP_H_INCLUDED
|
||||||
|
|||||||
+15
-7
@@ -1,12 +1,18 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Main entry/init for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
|
*
|
||||||
|
* Based on the mac80211 Prism54 code, which is
|
||||||
|
* Copyright (c) 2006, Michael Wu <flamingice@sourmilk.net>
|
||||||
|
*
|
||||||
|
* Based on the islsm (softmac prism54) driver, which is
|
||||||
|
* Copyright 2004-2006 Jean-Baptiste Note <jbnote@gmail.com>, et al.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
@@ -490,13 +496,14 @@ static struct ieee80211_hw *bes2600_init_common(size_t hw_priv_data_len)
|
|||||||
INIT_LIST_HEAD(&hw_priv->event_queue);
|
INIT_LIST_HEAD(&hw_priv->event_queue);
|
||||||
INIT_WORK(&hw_priv->event_handler, bes2600_event_handler);
|
INIT_WORK(&hw_priv->event_handler, bes2600_event_handler);
|
||||||
INIT_WORK(&hw_priv->ba_work, bes2600_ba_work);
|
INIT_WORK(&hw_priv->ba_work, bes2600_ba_work);
|
||||||
spin_lock_init(&hw_priv->ba_lock);
|
/* Patch D: ba_lock removed; ba_acc/ba_cnt/etc are atomic_t. */
|
||||||
timer_setup(&hw_priv->ba_timer, bes2600_ba_timer, 0);
|
timer_setup(&hw_priv->ba_timer, bes2600_ba_timer, 0);
|
||||||
|
|
||||||
if (unlikely(bes2600_queue_stats_init(&hw_priv->tx_queue_stats,
|
if (unlikely(bes2600_queue_stats_init(&hw_priv->tx_queue_stats,
|
||||||
WLAN_LINK_ID_MAX,
|
WLAN_LINK_ID_MAX,
|
||||||
bes2600_skb_dtor,
|
bes2600_skb_dtor,
|
||||||
hw_priv))) {
|
hw_priv))) {
|
||||||
|
destroy_workqueue(hw_priv->workqueue);
|
||||||
ieee80211_free_hw(hw);
|
ieee80211_free_hw(hw);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
@@ -508,6 +515,7 @@ static struct ieee80211_hw *bes2600_init_common(size_t hw_priv_data_len)
|
|||||||
for (; i > 0; i--)
|
for (; i > 0; i--)
|
||||||
bes2600_queue_deinit(&hw_priv->tx_queue[i - 1]);
|
bes2600_queue_deinit(&hw_priv->tx_queue[i - 1]);
|
||||||
bes2600_queue_stats_deinit(&hw_priv->tx_queue_stats);
|
bes2600_queue_stats_deinit(&hw_priv->tx_queue_stats);
|
||||||
|
destroy_workqueue(hw_priv->workqueue);
|
||||||
ieee80211_free_hw(hw);
|
ieee80211_free_hw(hw);
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|||||||
+6
-6
@@ -1,12 +1,12 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 power management API for BES2600 drivers
|
* Power management for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2011, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/platform_device.h>
|
#include <linux/platform_device.h>
|
||||||
|
|||||||
+6
-6
@@ -1,12 +1,12 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Mac80211 power management interface for BES2600 mac80211 drivers
|
* Power management interface for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2011, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef PM_H_INCLUDED
|
#ifndef PM_H_INCLUDED
|
||||||
|
|||||||
+9
-9
@@ -1,12 +1,12 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* O(1) TX queue with built-in allocator for BES2600 drivers
|
* O(1) TX queue for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <net/mac80211.h>
|
#include <net/mac80211.h>
|
||||||
@@ -829,19 +829,19 @@ int bes2600_queue_get_skb(struct bes2600_queue *queue, u32 packetID,
|
|||||||
bes2600_queue_parse_id(packetID, &queue_generation, &queue_id,
|
bes2600_queue_parse_id(packetID, &queue_generation, &queue_id,
|
||||||
&item_generation, &item_id, &if_id, &link_id);
|
&item_generation, &item_id, &if_id, &link_id);
|
||||||
|
|
||||||
spin_lock(&queue->stats->hw_priv->tx_loop.pending_record_lock);
|
spin_lock_bh(&queue->stats->hw_priv->tx_loop.pending_record_lock);
|
||||||
if (!list_empty(&queue->stats->hw_priv->tx_loop.pending_record_list)) {
|
if (!list_empty(&queue->stats->hw_priv->tx_loop.pending_record_list)) {
|
||||||
list_for_each_entry_safe(record_item, temp_record_item, &queue->stats->hw_priv->tx_loop.pending_record_list, head) {
|
list_for_each_entry_safe(record_item, temp_record_item, &queue->stats->hw_priv->tx_loop.pending_record_list, head) {
|
||||||
if (record_item->packetID == packetID) {
|
if (record_item->packetID == packetID) {
|
||||||
list_del(&record_item->head);
|
list_del(&record_item->head);
|
||||||
dev_kfree_skb(record_item->skb);
|
dev_kfree_skb(record_item->skb);
|
||||||
kfree(record_item);
|
kfree(record_item);
|
||||||
spin_unlock(&queue->stats->hw_priv->tx_loop.pending_record_lock);
|
spin_unlock_bh(&queue->stats->hw_priv->tx_loop.pending_record_lock);
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
spin_unlock(&queue->stats->hw_priv->tx_loop.pending_record_lock);
|
spin_unlock_bh(&queue->stats->hw_priv->tx_loop.pending_record_lock);
|
||||||
|
|
||||||
item = &queue->pool[item_id];
|
item = &queue->pool[item_id];
|
||||||
|
|
||||||
|
|||||||
+6
-6
@@ -1,12 +1,12 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* O(1) TX queue with built-in allocator for BES2600 drivers
|
* O(1) TX queue interface for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef BES2600_QUEUE_H_INCLUDED
|
#ifndef BES2600_QUEUE_H_INCLUDED
|
||||||
|
|||||||
+15
-8
@@ -1,12 +1,12 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Common sbus abstraction layer interface for bes2600 wireless driver
|
* Bus abstraction interface for BES2600
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
|
* Replaces hwbus.h from drivers/net/wireless/st/cw1200/
|
||||||
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef BES2600_SBUS_H
|
#ifndef BES2600_SBUS_H
|
||||||
@@ -83,11 +83,18 @@ struct sbus_ops {
|
|||||||
* Returns 0 on success or a negative errno.
|
* Returns 0 on success or a negative errno.
|
||||||
*/
|
*/
|
||||||
int (*bus_reset)(struct sbus_priv *self);
|
int (*bus_reset)(struct sbus_priv *self);
|
||||||
|
/*
|
||||||
|
* Read a batch of RX frames inline from the bus and deliver each
|
||||||
|
* one via bes2600_bh_handle_rx_skb(). Called from the bh thread
|
||||||
|
* (process context, sleepable). Replaces the
|
||||||
|
* sdio_rx_work + rx_queue + pipe_read relay (Patch C v3, 2026).
|
||||||
|
* Returns 0 on success, negative on read error.
|
||||||
|
*/
|
||||||
|
int (*bus_rx_batch)(struct sbus_priv *self);
|
||||||
};
|
};
|
||||||
|
|
||||||
void bes2600_irq_handler(struct bes2600_common *priv);
|
void bes2600_irq_handler(struct bes2600_common *priv);
|
||||||
|
|
||||||
/* This MUST be wrapped with hwbus_ops->lock/unlock! */
|
/* Patch H: __bes2600_irq_enable removed (was a stub). */
|
||||||
int __bes2600_irq_enable(int enable);
|
|
||||||
|
|
||||||
#endif /* BES2600_SBUS_H */
|
#endif /* BES2600_SBUS_H */
|
||||||
|
|||||||
+62
-25
@@ -1,12 +1,12 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Scan implementation for BES2600 mac80211 drivers
|
* Scan implementation for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/sched.h>
|
#include <linux/sched.h>
|
||||||
@@ -238,6 +238,36 @@ int bes2600_hw_scan(struct ieee80211_hw *hw,
|
|||||||
/* Scan when P2P_GO corrupt firmware MiniAP mode */
|
/* Scan when P2P_GO corrupt firmware MiniAP mode */
|
||||||
if (priv->join_status == BES2600_JOIN_STATUS_AP)
|
if (priv->join_status == BES2600_JOIN_STATUS_AP)
|
||||||
return -EOPNOTSUPP;
|
return -EOPNOTSUPP;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Firmware refuses WSM start-scan for 5 GHz with status 2 ("rejected
|
||||||
|
* by policy"); see besser issue #1. mac80211 splits multi-band
|
||||||
|
* hw_scan requests per-band when the driver does not set
|
||||||
|
* IEEE80211_HW_SINGLE_SCAN_ON_ALL_BANDS (we don't -- see
|
||||||
|
* ieee80211_hw_set() calls in bes2600_main.c), so each per-band call
|
||||||
|
* has req->channels[] from one band only (see ieee80211_prep_hw_scan
|
||||||
|
* in net/mac80211/scan.c). Refuse the 5 GHz iteration at the driver
|
||||||
|
* boundary so userspace gets a clean aborted-scan for that portion
|
||||||
|
* rather than waiting for the firmware reject to cascade up.
|
||||||
|
*
|
||||||
|
* Only the multi-channel case is refused (n_channels > 1): that's
|
||||||
|
* the per-band-sweep pattern mac80211 issues internally and the
|
||||||
|
* one that triggers the firmware storm at the per-band loop
|
||||||
|
* boundary. Single-channel 5 GHz scans (BSS verification, NM's
|
||||||
|
* per-freq iteration when 802-11-wireless.band=a is set) pass
|
||||||
|
* through to firmware, which generally accepts them since the
|
||||||
|
* storm is the back-to-back per-band issue, not a blanket 5 GHz
|
||||||
|
* reject. This preserves 5 GHz association via the
|
||||||
|
* "wpa_supplicant iterates freq_list per channel" path.
|
||||||
|
*
|
||||||
|
* Contract: per include/net/mac80211.h struct ieee80211_ops.hw_scan
|
||||||
|
* documentation, a negative return aborts the scan without requiring
|
||||||
|
* ieee80211_scan_completed().
|
||||||
|
*/
|
||||||
|
if (req->n_channels > 1 &&
|
||||||
|
req->channels[0]->band == NL80211_BAND_5GHZ)
|
||||||
|
return -EOPNOTSUPP;
|
||||||
|
|
||||||
#if 0
|
#if 0
|
||||||
if (work_pending(&priv->offchannel_work) ||
|
if (work_pending(&priv->offchannel_work) ||
|
||||||
(hw_priv->roc_if_id != -1)) {
|
(hw_priv->roc_if_id != -1)) {
|
||||||
@@ -257,18 +287,21 @@ int bes2600_hw_scan(struct ieee80211_hw *hw,
|
|||||||
|
|
||||||
bes2600_pwr_set_busy_event(hw_priv, BES_PWR_LOCK_ON_SCAN);
|
bes2600_pwr_set_busy_event(hw_priv, BES_PWR_LOCK_ON_SCAN);
|
||||||
|
|
||||||
frame.skb = ieee80211_probereq_get(hw, priv->vif->addr, NULL, 0,
|
|
||||||
req->ie_len);
|
|
||||||
if (!frame.skb)
|
|
||||||
return -ENOMEM;
|
|
||||||
|
|
||||||
if (req->ie_len)
|
|
||||||
skb_put_data(frame.skb, req->ie, req->ie_len);
|
|
||||||
|
|
||||||
/* will be unlocked in bes2600_scan_work() */
|
/* will be unlocked in bes2600_scan_work() */
|
||||||
down(&hw_priv->scan.lock);
|
down(&hw_priv->scan.lock);
|
||||||
down(&hw_priv->conf_lock);
|
down(&hw_priv->conf_lock);
|
||||||
|
|
||||||
|
frame.skb = ieee80211_probereq_get(hw, priv->vif->addr, NULL, 0,
|
||||||
|
req->ie_len);
|
||||||
|
if (!frame.skb) {
|
||||||
|
up(&hw_priv->conf_lock);
|
||||||
|
up(&hw_priv->scan.lock);
|
||||||
|
return -ENOMEM;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (req->ie_len)
|
||||||
|
skb_put_data(frame.skb, req->ie, req->ie_len);
|
||||||
|
|
||||||
if (frame.skb) {
|
if (frame.skb) {
|
||||||
int ret;
|
int ret;
|
||||||
//if (priv->if_id == 0)
|
//if (priv->if_id == 0)
|
||||||
@@ -286,9 +319,9 @@ int bes2600_hw_scan(struct ieee80211_hw *hw,
|
|||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
if (ret) {
|
if (ret) {
|
||||||
|
dev_kfree_skb(frame.skb);
|
||||||
up(&hw_priv->conf_lock);
|
up(&hw_priv->conf_lock);
|
||||||
up(&hw_priv->scan.lock);
|
up(&hw_priv->scan.lock);
|
||||||
dev_kfree_skb(frame.skb);
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -318,10 +351,10 @@ int bes2600_hw_scan(struct ieee80211_hw *hw,
|
|||||||
++hw_priv->scan.n_ssids;
|
++hw_priv->scan.n_ssids;
|
||||||
}
|
}
|
||||||
|
|
||||||
up(&hw_priv->conf_lock);
|
|
||||||
|
|
||||||
if (frame.skb)
|
if (frame.skb)
|
||||||
dev_kfree_skb(frame.skb);
|
dev_kfree_skb(frame.skb);
|
||||||
|
|
||||||
|
up(&hw_priv->conf_lock);
|
||||||
#ifdef WIFI_BT_COEXIST_EPTA_ENABLE
|
#ifdef WIFI_BT_COEXIST_EPTA_ENABLE
|
||||||
bwifi_change_current_status(hw_priv, BWIFI_STATUS_SCANNING);
|
bwifi_change_current_status(hw_priv, BWIFI_STATUS_SCANNING);
|
||||||
#endif
|
#endif
|
||||||
@@ -362,14 +395,18 @@ int bes2600_hw_sched_scan_start(struct ieee80211_hw *hw,
|
|||||||
if (req->n_ssids > hw->wiphy->max_scan_ssids)
|
if (req->n_ssids > hw->wiphy->max_scan_ssids)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
frame.skb = ieee80211_probereq_get(hw, priv->vif->addr, NULL, 0,
|
|
||||||
req->ie_len);
|
|
||||||
if (!frame.skb)
|
|
||||||
return -ENOMEM;
|
|
||||||
|
|
||||||
/* will be unlocked in bes2600_scan_work() */
|
/* will be unlocked in bes2600_scan_work() */
|
||||||
down(&hw_priv->scan.lock);
|
down(&hw_priv->scan.lock);
|
||||||
down(&hw_priv->conf_lock);
|
down(&hw_priv->conf_lock);
|
||||||
|
|
||||||
|
frame.skb = ieee80211_probereq_get(hw, priv->vif->addr, NULL, 0,
|
||||||
|
req->ie_len);
|
||||||
|
if (!frame.skb) {
|
||||||
|
up(&hw_priv->conf_lock);
|
||||||
|
up(&hw_priv->scan.lock);
|
||||||
|
return -ENOMEM;
|
||||||
|
}
|
||||||
|
|
||||||
if (frame.skb) {
|
if (frame.skb) {
|
||||||
int ret;
|
int ret;
|
||||||
if (priv->if_id == 0)
|
if (priv->if_id == 0)
|
||||||
@@ -380,9 +417,9 @@ int bes2600_hw_sched_scan_start(struct ieee80211_hw *hw,
|
|||||||
ret = wsm_set_probe_responder(priv, true);
|
ret = wsm_set_probe_responder(priv, true);
|
||||||
}
|
}
|
||||||
if (ret) {
|
if (ret) {
|
||||||
|
dev_kfree_skb(frame.skb);
|
||||||
up(&hw_priv->conf_lock);
|
up(&hw_priv->conf_lock);
|
||||||
up(&hw_priv->scan.lock);
|
up(&hw_priv->scan.lock);
|
||||||
dev_kfree_skb(frame.skb);
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -414,10 +451,10 @@ int bes2600_hw_sched_scan_start(struct ieee80211_hw *hw,
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
up(&hw_priv->conf_lock);
|
|
||||||
|
|
||||||
if (frame.skb)
|
if (frame.skb)
|
||||||
dev_kfree_skb(frame.skb);
|
dev_kfree_skb(frame.skb);
|
||||||
|
|
||||||
|
up(&hw_priv->conf_lock);
|
||||||
queue_work(hw_priv->workqueue, &hw_priv->scan.swork);
|
queue_work(hw_priv->workqueue, &hw_priv->scan.swork);
|
||||||
wiphy_warn(hw->wiphy, "<--[SCAN] Scheduled scan request.\n");
|
wiphy_warn(hw->wiphy, "<--[SCAN] Scheduled scan request.\n");
|
||||||
return 0;
|
return 0;
|
||||||
|
|||||||
+6
-6
@@ -1,12 +1,12 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Scan interface for BES2600 mac80211 drivers
|
* Scan interface for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef SCAN_H_INCLUDED
|
#ifndef SCAN_H_INCLUDED
|
||||||
|
|||||||
+53
-38
@@ -1,12 +1,12 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 STA API for BES2600 drivers
|
* Mac80211 STA API for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/vmalloc.h>
|
#include <linux/vmalloc.h>
|
||||||
@@ -1484,7 +1484,7 @@ void bes2600_event_handler(struct work_struct *work)
|
|||||||
IEEE80211_STYPE_DEAUTH | IEEE80211_FCTL_TODS);
|
IEEE80211_STYPE_DEAUTH | IEEE80211_FCTL_TODS);
|
||||||
deauth->u.deauth.reason_code = WLAN_REASON_DEAUTH_LEAVING;
|
deauth->u.deauth.reason_code = WLAN_REASON_DEAUTH_LEAVING;
|
||||||
deauth->seq_ctrl = 0;
|
deauth->seq_ctrl = 0;
|
||||||
ieee80211_rx_irqsafe(priv->hw, skb);
|
ieee80211_rx_ni(priv->hw, skb);
|
||||||
bes_devel(" Inactivity Deauth Frame sent for MAC SA %pM \t and DA %pM\n", deauth->sa, deauth->da);
|
bes_devel(" Inactivity Deauth Frame sent for MAC SA %pM \t and DA %pM\n", deauth->sa, deauth->da);
|
||||||
queue_work(priv->hw_priv->workqueue, &priv->set_tim_work);
|
queue_work(priv->hw_priv->workqueue, &priv->set_tim_work);
|
||||||
break;
|
break;
|
||||||
@@ -2342,14 +2342,19 @@ void bes2600_join_work(struct work_struct *work)
|
|||||||
//WARN_ON(wsm_reset(hw_priv, &reset, priv->if_id));
|
//WARN_ON(wsm_reset(hw_priv, &reset, priv->if_id));
|
||||||
WARN_ON(wsm_set_block_ack_policy(hw_priv,
|
WARN_ON(wsm_set_block_ack_policy(hw_priv,
|
||||||
0, hw_priv->ba_tid_mask, priv->if_id));
|
0, hw_priv->ba_tid_mask, priv->if_id));
|
||||||
spin_lock_bh(&hw_priv->ba_lock);
|
/*
|
||||||
hw_priv->ba_ena = false;
|
* Patch D: ba_lock removed. Disconnect-reset clears the
|
||||||
hw_priv->ba_cnt = 0;
|
* counters and the arm flag; producers racing here cannot
|
||||||
hw_priv->ba_acc = 0;
|
* cause harm — at worst they re-arm the timer and bump
|
||||||
|
* counters that will be cleared on the next timer tick.
|
||||||
|
*/
|
||||||
|
atomic_set(&hw_priv->ba_ena, 0);
|
||||||
|
atomic_set(&hw_priv->ba_cnt, 0);
|
||||||
|
atomic_set(&hw_priv->ba_acc, 0);
|
||||||
hw_priv->ba_hist = 0;
|
hw_priv->ba_hist = 0;
|
||||||
hw_priv->ba_cnt_rx = 0;
|
atomic_set(&hw_priv->ba_cnt_rx, 0);
|
||||||
hw_priv->ba_acc_rx = 0;
|
atomic_set(&hw_priv->ba_acc_rx, 0);
|
||||||
spin_unlock_bh(&hw_priv->ba_lock);
|
atomic_set(&hw_priv->ba_armed, 0);
|
||||||
|
|
||||||
mgmt_policy.protectedMgmtEnable = 0;
|
mgmt_policy.protectedMgmtEnable = 0;
|
||||||
mgmt_policy.unprotectedMgmtFramesAllowed = 1;
|
mgmt_policy.unprotectedMgmtFramesAllowed = 1;
|
||||||
@@ -2629,10 +2634,11 @@ void bes2600_ba_work(struct work_struct *work)
|
|||||||
return;*/
|
return;*/
|
||||||
|
|
||||||
bes_devel("BA work****\n");
|
bes_devel("BA work****\n");
|
||||||
spin_lock_bh(&hw_priv->ba_lock);
|
/*
|
||||||
// tx_ba_tid_mask = hw_priv->ba_ena ? hw_priv->ba_tid_mask : 0;
|
* Patch D: ba_lock removed. ba_tid_mask is u8 set once at init
|
||||||
|
* (main.c); reading it without a lock is fine.
|
||||||
|
*/
|
||||||
tx_ba_tid_mask = hw_priv->ba_tid_mask;
|
tx_ba_tid_mask = hw_priv->ba_tid_mask;
|
||||||
spin_unlock_bh(&hw_priv->ba_lock);
|
|
||||||
|
|
||||||
wsm_lock_tx(hw_priv);
|
wsm_lock_tx(hw_priv);
|
||||||
|
|
||||||
@@ -2645,37 +2651,49 @@ void bes2600_ba_work(struct work_struct *work)
|
|||||||
void bes2600_ba_timer(struct timer_list *t)
|
void bes2600_ba_timer(struct timer_list *t)
|
||||||
{
|
{
|
||||||
bool ba_ena;
|
bool ba_ena;
|
||||||
|
int cnt, acc, cnt_rx, acc_rx;
|
||||||
struct bes2600_common *hw_priv = from_timer(hw_priv, t, ba_timer);
|
struct bes2600_common *hw_priv = from_timer(hw_priv, t, ba_timer);
|
||||||
|
|
||||||
spin_lock_bh(&hw_priv->ba_lock);
|
/*
|
||||||
bes2600_debug_ba(hw_priv, hw_priv->ba_cnt, hw_priv->ba_acc,
|
* Patch D: ba_lock removed. Snapshot atomic counters into locals
|
||||||
hw_priv->ba_cnt_rx, hw_priv->ba_acc_rx);
|
* for the predicate evaluation; producers may race incrementing
|
||||||
|
* after the snapshot but the resulting decision is approximate
|
||||||
|
* which the policy already tolerates (next timer tick re-evaluates).
|
||||||
|
*/
|
||||||
|
cnt = atomic_read(&hw_priv->ba_cnt);
|
||||||
|
acc = atomic_read(&hw_priv->ba_acc);
|
||||||
|
cnt_rx = atomic_read(&hw_priv->ba_cnt_rx);
|
||||||
|
acc_rx = atomic_read(&hw_priv->ba_acc_rx);
|
||||||
|
|
||||||
|
bes2600_debug_ba(hw_priv, cnt, acc, cnt_rx, acc_rx);
|
||||||
|
|
||||||
if (atomic_read(&hw_priv->scan.in_progress)) {
|
if (atomic_read(&hw_priv->scan.in_progress)) {
|
||||||
hw_priv->ba_cnt = 0;
|
atomic_set(&hw_priv->ba_cnt, 0);
|
||||||
hw_priv->ba_acc = 0;
|
atomic_set(&hw_priv->ba_acc, 0);
|
||||||
hw_priv->ba_cnt_rx = 0;
|
atomic_set(&hw_priv->ba_cnt_rx, 0);
|
||||||
hw_priv->ba_acc_rx = 0;
|
atomic_set(&hw_priv->ba_acc_rx, 0);
|
||||||
goto skip_statistic_update;
|
atomic_set(&hw_priv->ba_armed, 0);
|
||||||
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (hw_priv->ba_cnt >= BES2600_BLOCK_ACK_CNT &&
|
if (cnt >= BES2600_BLOCK_ACK_CNT &&
|
||||||
(hw_priv->ba_acc / hw_priv->ba_cnt >= BES2600_BLOCK_ACK_THLD ||
|
(acc / cnt >= BES2600_BLOCK_ACK_THLD ||
|
||||||
(hw_priv->ba_cnt_rx >= BES2600_BLOCK_ACK_CNT &&
|
(cnt_rx >= BES2600_BLOCK_ACK_CNT &&
|
||||||
hw_priv->ba_acc_rx / hw_priv->ba_cnt_rx >=
|
acc_rx / cnt_rx >=
|
||||||
BES2600_BLOCK_ACK_THLD)))
|
BES2600_BLOCK_ACK_THLD)))
|
||||||
ba_ena = true;
|
ba_ena = true;
|
||||||
else
|
else
|
||||||
ba_ena = false;
|
ba_ena = false;
|
||||||
|
|
||||||
hw_priv->ba_cnt = 0;
|
atomic_set(&hw_priv->ba_cnt, 0);
|
||||||
hw_priv->ba_acc = 0;
|
atomic_set(&hw_priv->ba_acc, 0);
|
||||||
hw_priv->ba_cnt_rx = 0;
|
atomic_set(&hw_priv->ba_cnt_rx, 0);
|
||||||
hw_priv->ba_acc_rx = 0;
|
atomic_set(&hw_priv->ba_acc_rx, 0);
|
||||||
|
atomic_set(&hw_priv->ba_armed, 0);
|
||||||
|
|
||||||
if (ba_ena != hw_priv->ba_ena) {
|
if (ba_ena != !!atomic_read(&hw_priv->ba_ena)) {
|
||||||
if (ba_ena || ++hw_priv->ba_hist >= BES2600_BLOCK_ACK_HIST) {
|
if (ba_ena || ++hw_priv->ba_hist >= BES2600_BLOCK_ACK_HIST) {
|
||||||
hw_priv->ba_ena = ba_ena;
|
atomic_set(&hw_priv->ba_ena, ba_ena ? 1 : 0);
|
||||||
hw_priv->ba_hist = 0;
|
hw_priv->ba_hist = 0;
|
||||||
#if 0
|
#if 0
|
||||||
bes_devel("[STA] %s block ACK:\n",
|
bes_devel("[STA] %s block ACK:\n",
|
||||||
@@ -2685,9 +2703,6 @@ void bes2600_ba_timer(struct timer_list *t)
|
|||||||
}
|
}
|
||||||
} else if (hw_priv->ba_hist)
|
} else if (hw_priv->ba_hist)
|
||||||
--hw_priv->ba_hist;
|
--hw_priv->ba_hist;
|
||||||
|
|
||||||
skip_statistic_update:
|
|
||||||
spin_unlock_bh(&hw_priv->ba_lock);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
int bes2600_vif_setup(struct bes2600_vif *priv)
|
int bes2600_vif_setup(struct bes2600_vif *priv)
|
||||||
|
|||||||
+6
-6
@@ -1,12 +1,12 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Mac80211 STA interface for BES2600 mac80211 drivers
|
* Mac80211 STA API interface for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#include <linux/version.h>
|
#include <linux/version.h>
|
||||||
#ifndef STA_H_INCLUDED
|
#ifndef STA_H_INCLUDED
|
||||||
|
|||||||
+5
-8
@@ -1,12 +1,9 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Test-mode TX loopback for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#include "bes2600.h"
|
#include "bes2600.h"
|
||||||
#include "wsm.h"
|
#include "wsm.h"
|
||||||
@@ -112,9 +109,9 @@ void bes2600_tx_loop_set_enable(struct bes2600_common *hw_priv, bool need_warn)
|
|||||||
bes2600_queue_iterate_pending_packet(&hw_priv->tx_queue[i],
|
bes2600_queue_iterate_pending_packet(&hw_priv->tx_queue[i],
|
||||||
bes2600_tx_loop_item_pending_item);
|
bes2600_tx_loop_item_pending_item);
|
||||||
}
|
}
|
||||||
spin_lock(&hw_priv->tx_loop.pending_record_lock);
|
spin_lock_bh(&hw_priv->tx_loop.pending_record_lock);
|
||||||
bes2600_queue_iterate_record_pending_packet(hw_priv, bes2600_tx_loop_item_pending_item);
|
bes2600_queue_iterate_record_pending_packet(hw_priv, bes2600_tx_loop_item_pending_item);
|
||||||
spin_unlock(&hw_priv->tx_loop.pending_record_lock);
|
spin_unlock_bh(&hw_priv->tx_loop.pending_record_lock);
|
||||||
|
|
||||||
if (atomic_read(&hw_priv->bh_rx) > 0)
|
if (atomic_read(&hw_priv->bh_rx) > 0)
|
||||||
wake_up(&hw_priv->bh_wq);
|
wake_up(&hw_priv->bh_wq);
|
||||||
|
|||||||
+3
-6
@@ -1,12 +1,9 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* Test-mode TX loopback interface for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#ifndef __TX_LOOP_H__
|
#ifndef __TX_LOOP_H__
|
||||||
#define __TX_LOOP_H__
|
#define __TX_LOOP_H__
|
||||||
|
|||||||
+39
-18
@@ -1,12 +1,12 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Datapath implementation for BES2600 mac80211 drivers
|
* Datapath implementation for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <net/mac80211.h>
|
#include <net/mac80211.h>
|
||||||
@@ -995,14 +995,18 @@ bes2600_tx_h_ba_stat(struct bes2600_vif *priv,
|
|||||||
if (!ieee80211_is_data(t->hdr->frame_control))
|
if (!ieee80211_is_data(t->hdr->frame_control))
|
||||||
return;
|
return;
|
||||||
|
|
||||||
spin_lock_bh(&hw_priv->ba_lock);
|
/*
|
||||||
hw_priv->ba_acc += t->skb->len - t->hdrlen;
|
* Patch D: lock-free hot-path BA accounting. atomic_inc + atomic_add
|
||||||
if (!(hw_priv->ba_cnt_rx || hw_priv->ba_cnt)) {
|
* each per-frame; the once-per-window timer-arm uses cmpxchg on
|
||||||
|
* ba_armed so concurrent TX/RX can't both try to set the timer and
|
||||||
|
* we don't need cross-counter coherency on the ba_cnt/ba_cnt_rx pair.
|
||||||
|
*/
|
||||||
|
atomic_add(t->skb->len - t->hdrlen, &hw_priv->ba_acc);
|
||||||
|
atomic_inc(&hw_priv->ba_cnt);
|
||||||
|
if (atomic_cmpxchg(&hw_priv->ba_armed, 0, 1) == 0) {
|
||||||
mod_timer(&hw_priv->ba_timer,
|
mod_timer(&hw_priv->ba_timer,
|
||||||
jiffies + BES2600_BLOCK_ACK_INTERVAL);
|
jiffies + BES2600_BLOCK_ACK_INTERVAL);
|
||||||
}
|
}
|
||||||
hw_priv->ba_cnt++;
|
|
||||||
spin_unlock_bh(&hw_priv->ba_lock);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int
|
static int
|
||||||
@@ -1629,14 +1633,13 @@ bes2600_rx_h_ba_stat(struct bes2600_vif *priv,
|
|||||||
if (!priv->setbssparams_done)
|
if (!priv->setbssparams_done)
|
||||||
return;
|
return;
|
||||||
|
|
||||||
spin_lock_bh(&hw_priv->ba_lock);
|
/* Patch D: lock-free hot-path BA accounting; see TX side comment. */
|
||||||
hw_priv->ba_acc_rx += skb_len - hdrlen;
|
atomic_add(skb_len - hdrlen, &hw_priv->ba_acc_rx);
|
||||||
if (!(hw_priv->ba_cnt_rx || hw_priv->ba_cnt)) {
|
atomic_inc(&hw_priv->ba_cnt_rx);
|
||||||
|
if (atomic_cmpxchg(&hw_priv->ba_armed, 0, 1) == 0) {
|
||||||
mod_timer(&hw_priv->ba_timer,
|
mod_timer(&hw_priv->ba_timer,
|
||||||
jiffies + BES2600_BLOCK_ACK_INTERVAL);
|
jiffies + BES2600_BLOCK_ACK_INTERVAL);
|
||||||
}
|
}
|
||||||
hw_priv->ba_cnt_rx++;
|
|
||||||
spin_unlock_bh(&hw_priv->ba_lock);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void bes2600_rx_cb(struct bes2600_vif *priv,
|
void bes2600_rx_cb(struct bes2600_vif *priv,
|
||||||
@@ -1939,15 +1942,33 @@ void bes2600_rx_cb(struct bes2600_vif *priv,
|
|||||||
if (unlikely(bes2600_itp_rxed(hw_priv, skb)))
|
if (unlikely(bes2600_itp_rxed(hw_priv, skb)))
|
||||||
consume_skb(skb);
|
consume_skb(skb);
|
||||||
else if (unlikely(early_data)) {
|
else if (unlikely(early_data)) {
|
||||||
|
/*
|
||||||
|
* Patch E: when c7 has latched pm_unsupported (firmware
|
||||||
|
* doesn't honour PSM, see feedback_bes2600_firmware_no_psm),
|
||||||
|
* AP-side power-save state machine is dead and link entries
|
||||||
|
* never transition to BES2600_LINK_SOFT. The double-check
|
||||||
|
* branch under ps_state_lock is unreachable in that case,
|
||||||
|
* so skip the per-frame lock acquisition entirely and
|
||||||
|
* deliver to mac80211 directly.
|
||||||
|
*
|
||||||
|
* On firmware that does honour PSM (the latch self-clears
|
||||||
|
* if a real PM_INDICATION ever arrives — see c7), this
|
||||||
|
* predicate flips back to false and the original locked
|
||||||
|
* path is taken.
|
||||||
|
*/
|
||||||
|
if (hw_priv->bes_power.pm_unsupported) {
|
||||||
|
ieee80211_rx_ni(priv->hw, skb);
|
||||||
|
} else {
|
||||||
spin_lock_bh(&priv->ps_state_lock);
|
spin_lock_bh(&priv->ps_state_lock);
|
||||||
/* Double-check status with lock held */
|
/* Double-check status with lock held */
|
||||||
if (entry->status == BES2600_LINK_SOFT)
|
if (entry->status == BES2600_LINK_SOFT)
|
||||||
skb_queue_tail(&entry->rx_queue, skb);
|
skb_queue_tail(&entry->rx_queue, skb);
|
||||||
else
|
else
|
||||||
ieee80211_rx_irqsafe(priv->hw, skb);
|
ieee80211_rx_ni(priv->hw, skb);
|
||||||
spin_unlock_bh(&priv->ps_state_lock);
|
spin_unlock_bh(&priv->ps_state_lock);
|
||||||
|
}
|
||||||
} else {
|
} else {
|
||||||
ieee80211_rx_irqsafe(priv->hw, skb);
|
ieee80211_rx_ni(priv->hw, skb);
|
||||||
}
|
}
|
||||||
*skb_p = NULL;
|
*skb_p = NULL;
|
||||||
|
|
||||||
|
|||||||
+6
-6
@@ -1,12 +1,12 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* Datapath interface for BES2600 mac80211 drivers
|
* Datapath interface for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2010, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef BES2600_TXRX_H
|
#ifndef BES2600_TXRX_H
|
||||||
|
|||||||
@@ -1,12 +1,9 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* Mac80211 driver for BES2600 device
|
* WiFi testmode commands for BES2600
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Author:
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
#ifdef CONFIG_BES2600_TESTMODE
|
#ifdef CONFIG_BES2600_TESTMODE
|
||||||
#include <net/netlink.h>
|
#include <net/netlink.h>
|
||||||
|
|||||||
+7
-8
@@ -1,13 +1,12 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0-only
|
||||||
/*
|
/*
|
||||||
* WSM host interface (HI) implementation for
|
* WSM host interface for BES2600 mac80211 driver
|
||||||
* BES2600 mac80211 drivers.
|
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
|
*
|
||||||
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <linux/skbuff.h>
|
#include <linux/skbuff.h>
|
||||||
@@ -2413,7 +2412,7 @@ int wsm_handle_rx(struct bes2600_common *hw_priv, int id,
|
|||||||
if (!hw_priv->beacon_bkp)
|
if (!hw_priv->beacon_bkp)
|
||||||
hw_priv->beacon_bkp = \
|
hw_priv->beacon_bkp = \
|
||||||
skb_copy(hw_priv->beacon, GFP_ATOMIC);
|
skb_copy(hw_priv->beacon, GFP_ATOMIC);
|
||||||
ieee80211_rx_irqsafe(hw_priv->hw, hw_priv->beacon);
|
ieee80211_rx_ni(hw_priv->hw, hw_priv->beacon);
|
||||||
hw_priv->beacon = hw_priv->beacon_bkp;
|
hw_priv->beacon = hw_priv->beacon_bkp;
|
||||||
|
|
||||||
hw_priv->beacon_bkp = NULL;
|
hw_priv->beacon_bkp = NULL;
|
||||||
|
|||||||
+5
-9
@@ -1,16 +1,12 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0-only */
|
||||||
/*
|
/*
|
||||||
* WSM host interface (HI) interface for BES2600 mac80211 drivers
|
* WSM host interface for BES2600 mac80211 driver
|
||||||
*
|
*
|
||||||
* Copyright (c) 2022, Bestechnic
|
* Copyright (c) 2010, ST-Ericsson
|
||||||
* Author:
|
* Author: Dmitry Tarnyagin <dmitry.tarnyagin@lockless.no>
|
||||||
*
|
*
|
||||||
* Based on BES2600 UMAC WSM API, which is
|
* Copyright (c) 2022, Bestechnic (Beijing) Co., Ltd.
|
||||||
* Copyright (C) SA 2010
|
|
||||||
* Author: Stewart Mathers <stewart.mathers@stericsson.com>
|
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License version 2 as
|
|
||||||
* published by the Free Software Foundation.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef BES2600_WSM_H_INCLUDED
|
#ifndef BES2600_WSM_H_INCLUDED
|
||||||
|
|||||||
Reference in New Issue
Block a user