Compare commits
8 Commits
| Author | SHA1 | Date | |
|---|---|---|---|
| 699871fdc6 | |||
| 10a05d21bf | |||
| 6f13e008d2 | |||
| 3304b13a2b | |||
| 108d3967ea | |||
| c7ba2044b7 | |||
| a826f4db7d | |||
| d18aa6a9bc |
+46
-17
@@ -179,6 +179,34 @@ static int factory_section_read_file(char *path, void *buffer)
|
|||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* factory_section_write_file - Write data of specified length to file
|
||||||
|
* @path: path of the file
|
||||||
|
* @buffer: storage of write data
|
||||||
|
* @size: length of data to write
|
||||||
|
*
|
||||||
|
* Return: length on success, negative error code otherwise.
|
||||||
|
*/
|
||||||
|
static int factory_section_write_file(char *path, void *buffer, int size)
|
||||||
|
{
|
||||||
|
int ret = 0;
|
||||||
|
struct file *fp;
|
||||||
|
|
||||||
|
bes_devel("writing %s \n", path);
|
||||||
|
|
||||||
|
fp = filp_open(path, O_TRUNC | O_CREAT | O_RDWR, S_IRUSR);
|
||||||
|
if (IS_ERR(fp)) {
|
||||||
|
bes_devel("BES2600 : can't open %s\n",path);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = kernel_write(fp, buffer, size, &fp->f_pos);
|
||||||
|
|
||||||
|
filp_close(fp,NULL);
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
static inline int factory_parse(uint8_t *source_buf, struct factory_t *factory)
|
static inline int factory_parse(uint8_t *source_buf, struct factory_t *factory)
|
||||||
{
|
{
|
||||||
int ret = 0;
|
int ret = 0;
|
||||||
@@ -870,22 +898,9 @@ static inline int factory_build(uint8_t *dest_buf, struct factory_t *factory)
|
|||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
|
||||||
* Rebuild the serialised calibration blob in file_buffer from the live
|
|
||||||
* in-memory factory_save_p. Previously this function also persisted the
|
|
||||||
* blob back to FACTORY_PATH via filp_open(O_CREAT) + kernel_write(); that
|
|
||||||
* is not acceptable in mainline, so the persistence step has been removed.
|
|
||||||
*
|
|
||||||
* The in-memory factory_save_p remains authoritative for the duration of
|
|
||||||
* the session; on the next probe the firmware-class file is read back
|
|
||||||
* read-only via request_firmware(). If cross-reboot persistence of runtime
|
|
||||||
* calibration updates becomes a requirement, the expected route is a
|
|
||||||
* userspace-facing dump interface (debugfs read-only blob, or nl80211
|
|
||||||
* vendor command) that lets userspace read the serialised form and store
|
|
||||||
* it under its own privileges.
|
|
||||||
*/
|
|
||||||
static int bes2600_wifi_cali_table_save(u8 *file_buffer, struct factory_t *factory_save_p)
|
static int bes2600_wifi_cali_table_save(u8 *file_buffer, struct factory_t *factory_save_p)
|
||||||
{
|
{
|
||||||
|
int ret = 0;
|
||||||
int w_size;
|
int w_size;
|
||||||
u32 crc_len = sizeof(factory_data_t);
|
u32 crc_len = sizeof(factory_data_t);
|
||||||
#ifndef STANDARD_FACTORY_EFUSE_FLAG
|
#ifndef STANDARD_FACTORY_EFUSE_FLAG
|
||||||
@@ -894,11 +909,13 @@ static int bes2600_wifi_cali_table_save(u8 *file_buffer, struct factory_t *facto
|
|||||||
|
|
||||||
bes_devel("enter %s\n", __func__);
|
bes_devel("enter %s\n", __func__);
|
||||||
|
|
||||||
if (!file_buffer)
|
if (!file_buffer) {
|
||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
|
}
|
||||||
|
|
||||||
if (!factory_save_p)
|
if (!factory_save_p) {
|
||||||
return -ENOENT;
|
return -ENOENT;
|
||||||
|
}
|
||||||
|
|
||||||
/* All initialized to space */
|
/* All initialized to space */
|
||||||
memset(file_buffer, 32, FACTORY_MAX_SIZE);
|
memset(file_buffer, 32, FACTORY_MAX_SIZE);
|
||||||
@@ -910,10 +927,22 @@ static int bes2600_wifi_cali_table_save(u8 *file_buffer, struct factory_t *facto
|
|||||||
w_size = factory_build(file_buffer, factory_save_p);
|
w_size = factory_build(file_buffer, factory_save_p);
|
||||||
|
|
||||||
if (w_size < 0 || w_size > FACTORY_MAX_SIZE) {
|
if (w_size < 0 || w_size > FACTORY_MAX_SIZE) {
|
||||||
bes_err("%s: build failed! w_size = %d.", __func__, w_size);
|
bes_err("%s: build failed! ret = %d.", __func__, ret);
|
||||||
return -ETXTBSY;
|
return -ETXTBSY;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#ifdef FACTORY_SAVE_MULTI_PATH
|
||||||
|
/* avoid trailing characters '\0' */
|
||||||
|
file_buffer[w_size] = 32;
|
||||||
|
ret = factory_section_write_file(FACTORY_PATH, file_buffer, FACTORY_MAX_SIZE);
|
||||||
|
#else
|
||||||
|
ret = factory_section_write_file(FACTORY_PATH, file_buffer, w_size);
|
||||||
|
#endif
|
||||||
|
if(ret < 0) {
|
||||||
|
bes_err("%s: write failed! ret = %d.", __func__, ret);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
+2
-13
@@ -1388,14 +1388,7 @@ static void bes2600_gpio_wakeup_mcu(struct sbus_priv *self, int flag)
|
|||||||
|
|
||||||
/* error check */
|
/* error check */
|
||||||
if((self->gpio_wakup_flags & BIT(flag)) != 0) {
|
if((self->gpio_wakup_flags & BIT(flag)) != 0) {
|
||||||
/*
|
bes_err( "repeat set gpio_wake_flag, sub_sys:%d", flag);
|
||||||
* Multiple subsystems holding wake is the steady-state case
|
|
||||||
* (e.g. WIFI + BT both want MCU awake). Demoted from bes_err
|
|
||||||
* to bes_devel since it isn't an error - the GPIO is already
|
|
||||||
* asserted high and the subsystem is now also tracked.
|
|
||||||
*/
|
|
||||||
bes_devel("repeat set gpio_wake_flag, sub_sys:%d\n", flag);
|
|
||||||
self->gpio_wakup_flags |= BIT(flag);
|
|
||||||
mutex_unlock(&self->io_mutex);
|
mutex_unlock(&self->io_mutex);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
@@ -1427,11 +1420,7 @@ static void bes2600_gpio_allow_mcu_sleep(struct sbus_priv *self, int flag)
|
|||||||
|
|
||||||
/* error check */
|
/* error check */
|
||||||
if((self->gpio_wakup_flags & BIT(flag)) == 0) {
|
if((self->gpio_wakup_flags & BIT(flag)) == 0) {
|
||||||
/*
|
bes_err( "repeat clear gpio_wake_flag, sub_sys:%d", flag);
|
||||||
* Mirror of the wake path: a clear when the bit is already
|
|
||||||
* clear is racy bookkeeping, not a hardware error.
|
|
||||||
*/
|
|
||||||
bes_devel("repeat clear gpio_wake_flag, sub_sys:%d\n", flag);
|
|
||||||
mutex_unlock(&self->io_mutex);
|
mutex_unlock(&self->io_mutex);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -125,6 +125,8 @@ int bes_host_slave_sync(struct bes2600_common *hw_priv)
|
|||||||
}
|
}
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
//#define DATA_DUMP_OBSERVE
|
||||||
|
|
||||||
static int bes_firmware_download_write_reg(struct platform_fw_t *fw_data, u32 addr, u32 val)
|
static int bes_firmware_download_write_reg(struct platform_fw_t *fw_data, u32 addr, u32 val)
|
||||||
{
|
{
|
||||||
u8 frame_num = 0;
|
u8 frame_num = 0;
|
||||||
@@ -466,6 +468,14 @@ static int bes_firmware_download(struct platform_fw_t *fw_data, const char *fw_n
|
|||||||
|
|
||||||
const struct firmware *fw_bin;
|
const struct firmware *fw_bin;
|
||||||
|
|
||||||
|
#ifdef DATA_DUMP_OBSERVE
|
||||||
|
char *observe;
|
||||||
|
size_t observe_len;
|
||||||
|
loff_t observe_off = 0;
|
||||||
|
mm_segment_t old_fs;
|
||||||
|
struct file *observe_file = NULL;
|
||||||
|
#endif
|
||||||
|
|
||||||
struct fw_msg_hdr_t header;
|
struct fw_msg_hdr_t header;
|
||||||
struct fw_info_t fw_info;
|
struct fw_info_t fw_info;
|
||||||
struct download_fw_t download_addr;
|
struct download_fw_t download_addr;
|
||||||
@@ -573,6 +583,14 @@ retry:
|
|||||||
}
|
}
|
||||||
download_addr.addr = fw_info.addr;
|
download_addr.addr = fw_info.addr;
|
||||||
|
|
||||||
|
#ifdef DATA_DUMP_OBSERVE
|
||||||
|
observe_file = filp_open("/lib/firmware/bes2002_fw_write.bin", O_CREAT | O_RDWR, 0);
|
||||||
|
if (IS_ERR(observe_file)) {
|
||||||
|
bes_err("create data_dump file err:%ld\n", IS_ERR(observe_file));
|
||||||
|
observe_file = NULL;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
while (code_length) {
|
while (code_length) {
|
||||||
|
|
||||||
#if 1
|
#if 1
|
||||||
@@ -622,6 +640,17 @@ retry:
|
|||||||
//mdelay(5000);
|
//mdelay(5000);
|
||||||
bes_devel("tx_download_firmware_data:%x %d\n", download_addr.addr, length);
|
bes_devel("tx_download_firmware_data:%x %d\n", download_addr.addr, length);
|
||||||
|
|
||||||
|
#ifdef DATA_DUMP_OBSERVE
|
||||||
|
if (observe_file) {
|
||||||
|
observe = (char *)(long_buf + sizeof(struct fw_msg_hdr_t) + sizeof(struct download_fw_t));
|
||||||
|
observe_len = length - sizeof(struct fw_msg_hdr_t) - sizeof(struct download_fw_t);
|
||||||
|
old_fs = get_fs();
|
||||||
|
set_fs(KERNEL_DS);
|
||||||
|
vfs_write(observe_file, observe, observe_len, &observe_off);
|
||||||
|
set_fs(old_fs);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
ret = bes2600_data_write(long_buf, length > 512 ? length : 512);
|
ret = bes2600_data_write(long_buf, length > 512 ? length : 512);
|
||||||
if (ret) {
|
if (ret) {
|
||||||
bes_err("tx download fw data err:%d\n", ret);
|
bes_err("tx download fw data err:%d\n", ret);
|
||||||
@@ -803,6 +832,11 @@ retry:
|
|||||||
|
|
||||||
err2:
|
err2:
|
||||||
kfree(long_buf);
|
kfree(long_buf);
|
||||||
|
#ifdef DATA_DUMP_OBSERVE
|
||||||
|
if (observe_file) {
|
||||||
|
filp_close(observe_file, NULL);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
err1:
|
err1:
|
||||||
kfree(short_buf);
|
kfree(short_buf);
|
||||||
release_firmware(fw_bin);
|
release_firmware(fw_bin);
|
||||||
|
|||||||
+11
-197
@@ -467,45 +467,6 @@ static void bes2600_pwr_device_enter_lp_mode(struct bes2600_common *hw_priv)
|
|||||||
bes_devel("device enter sleep\n");
|
bes_devel("device enter sleep\n");
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
|
||||||
* Number of consecutive bes2600_pwr_enter_lp_mode timeouts (with zero
|
|
||||||
* PM_INDICATIONs received) before we conclude the firmware does not
|
|
||||||
* honor host-driven PSM and switch to a sticky skip path.
|
|
||||||
*/
|
|
||||||
#define BES2600_PM_UNSUPPORTED_THRESHOLD 3
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Latch pm_unsupported = true and force chip_pm_state = ACTIVE so the
|
|
||||||
* c6.2 wake-side skip branch covers bes2600_pwr_device_exit_lp_mode.
|
|
||||||
* Called after BES2600_PM_UNSUPPORTED_THRESHOLD consecutive enter_lp_mode
|
|
||||||
* timeouts with zero PM_INDICATIONs.
|
|
||||||
*/
|
|
||||||
static void bes2600_pwr_latch_pm_unsupported(struct bes2600_common *hw_priv)
|
|
||||||
{
|
|
||||||
bes_warn("PSM not honored (%u timeouts), switching to skip mode\n",
|
|
||||||
hw_priv->bes_power.pm_consecutive_timeouts);
|
|
||||||
hw_priv->bes_power.pm_unsupported = true;
|
|
||||||
atomic_set(&hw_priv->bes_power.chip_pm_state,
|
|
||||||
BES2600_CHIP_PM_ACTIVE);
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Hold the MCU wake-flag bit permanently. Without this, every
|
|
||||||
* sdio_rx_work invocation hits bes2600_gpio_wakeup_mcu(SDIO_RX)
|
|
||||||
* when gpio_wakup_flags == 0, drives the GPIO high and msleeps
|
|
||||||
* 10 ms per RX. With ~50 RX/s of beacons + multicast that's
|
|
||||||
* ~50%% of the bes_sdio workqueue thread blocked in msleep,
|
|
||||||
* which directly caps RX throughput. Holding the MCU bit makes
|
|
||||||
* those calls bit-only bookkeeping (gpio_wakeup = (flags == 0)
|
|
||||||
* stays false, no GPIO toggle, no msleep). The bit is never
|
|
||||||
* cleared once pm_unsupported is set because
|
|
||||||
* bes2600_pwr_device_enter_lp_mode is unreachable under the
|
|
||||||
* early-return.
|
|
||||||
*/
|
|
||||||
if (hw_priv->sbus_ops->gpio_wake)
|
|
||||||
hw_priv->sbus_ops->gpio_wake(hw_priv->sbus_priv,
|
|
||||||
GPIO_WAKE_FLAG_MCU);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int bes2600_pwr_enter_lp_mode(struct bes2600_common *hw_priv)
|
static int bes2600_pwr_enter_lp_mode(struct bes2600_common *hw_priv)
|
||||||
{
|
{
|
||||||
int i = 0;
|
int i = 0;
|
||||||
@@ -515,17 +476,6 @@ static int bes2600_pwr_enter_lp_mode(struct bes2600_common *hw_priv)
|
|||||||
char ip_str[20];
|
char ip_str[20];
|
||||||
unsigned long status = 0;
|
unsigned long status = 0;
|
||||||
|
|
||||||
/*
|
|
||||||
* Sticky early-return when we've previously concluded the firmware
|
|
||||||
* doesn't honor PSM. Each attempt would otherwise burn 5s on a
|
|
||||||
* doomed wait_for_completion_timeout and produce a noisy three-line
|
|
||||||
* cascade in dmesg every time power_down_work retries (every
|
|
||||||
* ~10s). The chip stays in active mode, which on this firmware is
|
|
||||||
* the de-facto state anyway.
|
|
||||||
*/
|
|
||||||
if (hw_priv->bes_power.pm_unsupported)
|
|
||||||
return -EOPNOTSUPP;
|
|
||||||
|
|
||||||
/* set interface low power configuration */
|
/* set interface low power configuration */
|
||||||
bes2600_for_each_vif(hw_priv, priv, i) {
|
bes2600_for_each_vif(hw_priv, priv, i) {
|
||||||
#ifdef P2P_MULTIVIF
|
#ifdef P2P_MULTIVIF
|
||||||
@@ -574,17 +524,7 @@ static int bes2600_pwr_enter_lp_mode(struct bes2600_common *hw_priv)
|
|||||||
bes_devel("%s, psMode:%s, fastPsmIdlePeriod:%d apPsmChangePeriod:%d minAutoPsPollPeriod:%d\n",
|
bes_devel("%s, psMode:%s, fastPsmIdlePeriod:%d apPsmChangePeriod:%d minAutoPsPollPeriod:%d\n",
|
||||||
__func__, bes2600_get_ps_mode_str(priv->powersave_mode.pmMode), priv->powersave_mode.fastPsmIdlePeriod,
|
__func__, bes2600_get_ps_mode_str(priv->powersave_mode.pmMode), priv->powersave_mode.fastPsmIdlePeriod,
|
||||||
priv->powersave_mode.apPsmChangePeriod, priv->powersave_mode.minAutoPsPollPeriod);
|
priv->powersave_mode.apPsmChangePeriod, priv->powersave_mode.minAutoPsPollPeriod);
|
||||||
/*
|
|
||||||
* Reinit BEFORE the WSM goes out, so a stale
|
|
||||||
* indication from a previous cycle cannot have
|
|
||||||
* primed pm_enter_cmpl. From here until the
|
|
||||||
* indication callback's cmpxchg(1->0) on
|
|
||||||
* pm_set_in_process, only the indication for
|
|
||||||
* THIS request can complete the wait.
|
|
||||||
*/
|
|
||||||
reinit_completion(&hw_priv->bes_power.pm_enter_cmpl);
|
|
||||||
atomic_set(&hw_priv->bes_power.pm_set_in_process, 1);
|
atomic_set(&hw_priv->bes_power.pm_set_in_process, 1);
|
||||||
|
|
||||||
ret = bes2600_set_pm(priv, &priv->powersave_mode);
|
ret = bes2600_set_pm(priv, &priv->powersave_mode);
|
||||||
if (ret) {
|
if (ret) {
|
||||||
atomic_set(&hw_priv->bes_power.pm_set_in_process, 0);
|
atomic_set(&hw_priv->bes_power.pm_set_in_process, 0);
|
||||||
@@ -595,36 +535,11 @@ static int bes2600_pwr_enter_lp_mode(struct bes2600_common *hw_priv)
|
|||||||
|
|
||||||
/* wait power save mode changed indication */
|
/* wait power save mode changed indication */
|
||||||
status = wait_for_completion_timeout(&hw_priv->bes_power.pm_enter_cmpl, 5 * HZ);
|
status = wait_for_completion_timeout(&hw_priv->bes_power.pm_enter_cmpl, 5 * HZ);
|
||||||
|
atomic_set(&hw_priv->bes_power.pm_set_in_process, 0);
|
||||||
|
reinit_completion(&hw_priv->bes_power.pm_enter_cmpl);
|
||||||
if (!status) {
|
if (!status) {
|
||||||
/*
|
bes_err("%s, wait pm ind timeout\n", __func__);
|
||||||
* The indication callback only fires
|
|
||||||
* complete() when it observes
|
|
||||||
* pm_set_in_process == 1; cmpxchg it
|
|
||||||
* to 0 here so a late indication
|
|
||||||
* cannot prime the next wait.
|
|
||||||
*
|
|
||||||
* If we win the cmpxchg, this is a
|
|
||||||
* real timeout: the firmware's PS
|
|
||||||
* state is unknown to us. Mark it as
|
|
||||||
* such so the next wake path can
|
|
||||||
* probe before assuming the chip is
|
|
||||||
* still active.
|
|
||||||
*
|
|
||||||
* If we lose the cmpxchg, the
|
|
||||||
* indication arrived between the
|
|
||||||
* wait timing out and us getting
|
|
||||||
* here; treat as success.
|
|
||||||
*/
|
|
||||||
if (atomic_cmpxchg(&hw_priv->bes_power.pm_set_in_process,
|
|
||||||
1, 0) == 1) {
|
|
||||||
bes_devel("%s, wait pm ind timeout\n", __func__);
|
|
||||||
atomic_set(&hw_priv->bes_power.chip_pm_state,
|
|
||||||
BES2600_CHIP_PM_UNKNOWN);
|
|
||||||
timeouts++;
|
timeouts++;
|
||||||
if (++hw_priv->bes_power.pm_consecutive_timeouts
|
|
||||||
>= BES2600_PM_UNSUPPORTED_THRESHOLD)
|
|
||||||
bes2600_pwr_latch_pm_unsupported(hw_priv);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
bes_devel("skip enter lp mode\n");
|
bes_devel("skip enter lp mode\n");
|
||||||
@@ -639,35 +554,10 @@ static int bes2600_pwr_enter_lp_mode(struct bes2600_common *hw_priv)
|
|||||||
* in an inconsistent state that cascades into SDIO TX errors on
|
* in an inconsistent state that cascades into SDIO TX errors on
|
||||||
* the BES2600.
|
* the BES2600.
|
||||||
*/
|
*/
|
||||||
if (timeouts == 0) {
|
if (timeouts == 0)
|
||||||
bes2600_pwr_device_enter_lp_mode(hw_priv);
|
bes2600_pwr_device_enter_lp_mode(hw_priv);
|
||||||
} else {
|
else
|
||||||
/*
|
|
||||||
* device_enter_lp_mode() was skipped (one or more VIFs
|
|
||||||
* timed out waiting for the firmware indication) so its
|
|
||||||
* gpio_sleep(MCU) - which drops the wake-flag bit and, if
|
|
||||||
* no other subsystem holds the wake, drives the GPIO low -
|
|
||||||
* never ran. Without it the bit stays asserted, and the
|
|
||||||
* next bes2600_pwr_device_exit_lp_mode() calls
|
|
||||||
* gpio_wake(MCU) into a "bit already set" no-op: the GPIO
|
|
||||||
* never re-edges, sbus_active() exhausts its 200x2ms
|
|
||||||
* MCU_WAKEUP_READY budget against an unwoken chip, and
|
|
||||||
* the first TX after idle stalls for several seconds.
|
|
||||||
*
|
|
||||||
* Drop the MCU wake-flag bit explicitly here so the next
|
|
||||||
* wake injects a real GPIO edge. gpio_allow_mcu_sleep
|
|
||||||
* preserves multi-subsystem semantics: it only drives the
|
|
||||||
* GPIO low when no other subsystem still holds wake; if
|
|
||||||
* BT or another holder is keeping the chip awake, the
|
|
||||||
* GPIO stays high and the bit clear here is purely
|
|
||||||
* bookkeeping (so the next gpio_wake doesn't no-op).
|
|
||||||
*/
|
|
||||||
if (!hw_priv->bes_power.pm_unsupported &&
|
|
||||||
hw_priv->sbus_ops->gpio_sleep)
|
|
||||||
hw_priv->sbus_ops->gpio_sleep(hw_priv->sbus_priv,
|
|
||||||
GPIO_WAKE_FLAG_MCU);
|
|
||||||
ret = -ETIMEDOUT;
|
ret = -ETIMEDOUT;
|
||||||
}
|
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
@@ -675,61 +565,19 @@ static int bes2600_pwr_enter_lp_mode(struct bes2600_common *hw_priv)
|
|||||||
static void bes2600_pwr_device_exit_lp_mode(struct bes2600_common *hw_priv)
|
static void bes2600_pwr_device_exit_lp_mode(struct bes2600_common *hw_priv)
|
||||||
{
|
{
|
||||||
int ret = 0;
|
int ret = 0;
|
||||||
enum bes2600_chip_pm_state state;
|
|
||||||
struct wsm_operational_mode mode = {
|
struct wsm_operational_mode mode = {
|
||||||
.power_mode = wsm_power_mode_active,
|
.power_mode = wsm_power_mode_active,
|
||||||
.disableMoreFlagUsage = true,
|
.disableMoreFlagUsage = true,
|
||||||
};
|
};
|
||||||
|
|
||||||
/*
|
|
||||||
* Consult chip_pm_state set by bes2600_pwr_notify_ps_changed().
|
|
||||||
* If we last saw the firmware confirm ACTIVE, skip ONLY the
|
|
||||||
* gpio_wake + sbus_active wake handshake - the GPIO is already
|
|
||||||
* asserted high and the SDIO MCU subsystem is already running,
|
|
||||||
* so another sbus_active() round-trip just hits its 200x2ms
|
|
||||||
* timeout because the firmware has nothing to do.
|
|
||||||
*
|
|
||||||
* wsm_set_operational_mode() below is NOT part of the wake
|
|
||||||
* handshake; it is the operational-mode setter the firmware
|
|
||||||
* tracks per call. Skipping it leaves the chip's SDIO state
|
|
||||||
* machine without a fresh operational-mode update, which on
|
|
||||||
* PineTab2 wedges the bus (-EBUSY on next sdio_rx_work read)
|
|
||||||
* within a few seconds of probe completion. So it must run
|
|
||||||
* unconditionally.
|
|
||||||
*/
|
|
||||||
state = atomic_read(&hw_priv->bes_power.chip_pm_state);
|
|
||||||
if (state == BES2600_CHIP_PM_ACTIVE) {
|
|
||||||
bes_devel("device_exit_lp_mode: chip already ACTIVE, skipping wake handshake\n");
|
|
||||||
} else {
|
|
||||||
bes_devel("host lock lmac\n");
|
bes_devel("host lock lmac\n");
|
||||||
if (hw_priv->sbus_ops->gpio_wake)
|
if(hw_priv->sbus_ops->gpio_wake)
|
||||||
hw_priv->sbus_ops->gpio_wake(hw_priv->sbus_priv,
|
hw_priv->sbus_ops->gpio_wake(hw_priv->sbus_priv, GPIO_WAKE_FLAG_MCU);
|
||||||
GPIO_WAKE_FLAG_MCU);
|
|
||||||
|
|
||||||
if (hw_priv->sbus_ops->sbus_active) {
|
if(hw_priv->sbus_ops->sbus_active) {
|
||||||
ret = hw_priv->sbus_ops->sbus_active(hw_priv->sbus_priv,
|
ret = hw_priv->sbus_ops->sbus_active(hw_priv->sbus_priv, SUBSYSTEM_MCU);
|
||||||
SUBSYSTEM_MCU);
|
if (ret)
|
||||||
if (ret) {
|
|
||||||
/*
|
|
||||||
* MCU_WAKEUP_READY did not arrive within
|
|
||||||
* the SDIO handshake window. Record state
|
|
||||||
* as UNKNOWN so the next exit_lp_mode call
|
|
||||||
* also runs the full wake sequence (no
|
|
||||||
* skip), but still send operational_mode
|
|
||||||
* below to match pre-c6 behaviour - the
|
|
||||||
* WSM may succeed even if the SDIO active
|
|
||||||
* confirm was lost, and if it fails too,
|
|
||||||
* we just emit a second devel-level error.
|
|
||||||
* Repeated UNKNOWN is the signal for the
|
|
||||||
* LMAC active-monitor to eventually
|
|
||||||
* escalate to bus_reset (c5.2's
|
|
||||||
* mmc_hw_reset path).
|
|
||||||
*/
|
|
||||||
bes_err("%s, active mcu fail\n", __func__);
|
bes_err("%s, active mcu fail\n", __func__);
|
||||||
atomic_set(&hw_priv->bes_power.chip_pm_state,
|
|
||||||
BES2600_CHIP_PM_UNKNOWN);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
ret = wsm_set_operational_mode(hw_priv, &mode, 0);
|
ret = wsm_set_operational_mode(hw_priv, &mode, 0);
|
||||||
@@ -985,9 +833,6 @@ void bes2600_pwr_init(struct bes2600_common *hw_priv)
|
|||||||
hw_priv->bes_power.power_up_task = NULL;
|
hw_priv->bes_power.power_up_task = NULL;
|
||||||
mutex_init(&hw_priv->bes_power.pwr_mutex);
|
mutex_init(&hw_priv->bes_power.pwr_mutex);
|
||||||
atomic_set(&hw_priv->bes_power.dev_state, 0);
|
atomic_set(&hw_priv->bes_power.dev_state, 0);
|
||||||
atomic_set(&hw_priv->bes_power.chip_pm_state, BES2600_CHIP_PM_UNKNOWN);
|
|
||||||
hw_priv->bes_power.pm_unsupported = false;
|
|
||||||
hw_priv->bes_power.pm_consecutive_timeouts = 0;
|
|
||||||
init_completion(&hw_priv->bes_power.pm_enter_cmpl);
|
init_completion(&hw_priv->bes_power.pm_enter_cmpl);
|
||||||
sema_init(&hw_priv->bes_power.sync_lock, 1);
|
sema_init(&hw_priv->bes_power.sync_lock, 1);
|
||||||
device_set_wakeup_capable(hw_priv->pdev, true);
|
device_set_wakeup_capable(hw_priv->pdev, true);
|
||||||
@@ -1368,40 +1213,9 @@ int bes2600_pwr_clear_busy_event(struct bes2600_common *hw_priv, u32 event)
|
|||||||
|
|
||||||
void bes2600_pwr_notify_ps_changed(struct bes2600_common *hw_priv, u8 psmode)
|
void bes2600_pwr_notify_ps_changed(struct bes2600_common *hw_priv, u8 psmode)
|
||||||
{
|
{
|
||||||
/*
|
if((psmode & 0x01) != WSM_PSM_ACTIVE) {
|
||||||
* The firmware sends a PM-changed indication for every transition,
|
|
||||||
* including ones we didn't ask for (firmware-internal coex moves,
|
|
||||||
* idle-driven aging). Update chip_pm_state unconditionally so the
|
|
||||||
* wake path can use it, but only fire pm_enter_cmpl when a host-
|
|
||||||
* initiated set_pm is actually in flight - otherwise a stale
|
|
||||||
* indication can prime a future wait against a freshly
|
|
||||||
* reinit_completion()'ed state.
|
|
||||||
*/
|
|
||||||
/*
|
|
||||||
* Any PM indication, whatever its psmode, proves the firmware is
|
|
||||||
* actually emitting them. Reset the consecutive-timeout counter
|
|
||||||
* so a transient stall doesn't permanently disable PSM, and clear
|
|
||||||
* pm_unsupported if a previous run had latched it.
|
|
||||||
*/
|
|
||||||
hw_priv->bes_power.pm_consecutive_timeouts = 0;
|
|
||||||
if (hw_priv->bes_power.pm_unsupported) {
|
|
||||||
bes_warn("PM indication arrived after pm_unsupported was set; re-enabling PSM transitions\n");
|
|
||||||
hw_priv->bes_power.pm_unsupported = false;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ((psmode & 0x01) != WSM_PSM_ACTIVE) {
|
|
||||||
atomic_set(&hw_priv->bes_power.chip_pm_state,
|
|
||||||
BES2600_CHIP_PM_LP);
|
|
||||||
if (atomic_cmpxchg(&hw_priv->bes_power.pm_set_in_process,
|
|
||||||
1, 0) == 1) {
|
|
||||||
bes_devel("complete pm_enter_cmpl\n");
|
bes_devel("complete pm_enter_cmpl\n");
|
||||||
complete(&hw_priv->bes_power.pm_enter_cmpl);
|
complete(&hw_priv->bes_power.pm_enter_cmpl);
|
||||||
} else {
|
|
||||||
bes_devel("PM ind (LP) without pending wait; state recorded\n");
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
atomic_set(&hw_priv->bes_power.chip_pm_state,
|
|
||||||
BES2600_CHIP_PM_ACTIVE);
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@@ -64,20 +64,6 @@ enum power_down_state
|
|||||||
POWER_DOWN_STATE_UNLOCKED,
|
POWER_DOWN_STATE_UNLOCKED,
|
||||||
};
|
};
|
||||||
|
|
||||||
/*
|
|
||||||
* Confirmed PM state of the firmware-side chip. Tracks what the host
|
|
||||||
* has *seen* the firmware acknowledge, not what the host has
|
|
||||||
* requested. UNKNOWN means a host-initiated transition timed out
|
|
||||||
* before the firmware indication arrived; the next wake path should
|
|
||||||
* treat it as "we don't know" and probe before issuing GPIO/SDIO
|
|
||||||
* wakeup ops.
|
|
||||||
*/
|
|
||||||
enum bes2600_chip_pm_state {
|
|
||||||
BES2600_CHIP_PM_ACTIVE = 0,
|
|
||||||
BES2600_CHIP_PM_LP,
|
|
||||||
BES2600_CHIP_PM_UNKNOWN,
|
|
||||||
};
|
|
||||||
|
|
||||||
typedef void (*bes_pwr_enter_lp_cb)(struct bes2600_common *hw_priv);
|
typedef void (*bes_pwr_enter_lp_cb)(struct bes2600_common *hw_priv);
|
||||||
typedef void (*bes_pwr_exit_lp_cb)(struct bes2600_common *hw_priv);
|
typedef void (*bes_pwr_exit_lp_cb)(struct bes2600_common *hw_priv);
|
||||||
|
|
||||||
@@ -120,16 +106,6 @@ struct bes2600_pwr_t
|
|||||||
bool ap_lp_bad;
|
bool ap_lp_bad;
|
||||||
struct bes2600_pwr_event_t pwr_events[BES2600_DELAY_EVENT_NUM];
|
struct bes2600_pwr_event_t pwr_events[BES2600_DELAY_EVENT_NUM];
|
||||||
atomic_t pm_set_in_process;
|
atomic_t pm_set_in_process;
|
||||||
atomic_t chip_pm_state;
|
|
||||||
/*
|
|
||||||
* Sticky flag set after BES2600_PM_UNSUPPORTED_THRESHOLD
|
|
||||||
* consecutive enter_lp_mode timeouts with zero PM_INDICATIONs
|
|
||||||
* received from firmware. Indicates this chip's firmware does
|
|
||||||
* not honor host-driven PSM transitions; further attempts are
|
|
||||||
* skipped to avoid the 5s timeout cascade.
|
|
||||||
*/
|
|
||||||
bool pm_unsupported;
|
|
||||||
unsigned int pm_consecutive_timeouts;
|
|
||||||
};
|
};
|
||||||
|
|
||||||
#ifdef CONFIG_BES2600_WOWLAN
|
#ifdef CONFIG_BES2600_WOWLAN
|
||||||
|
|||||||
@@ -790,6 +790,41 @@ void bes2600_core_release(struct bes2600_common *self)
|
|||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#if (GET_MAC_ADDR_METHOD == 2) || (GET_MAC_ADDR_METHOD == 3) /* To use macaddr and ps mode of customers */
|
||||||
|
int access_file(char *path, char *buffer, int size, int isRead)
|
||||||
|
{
|
||||||
|
int ret=0;
|
||||||
|
struct file *fp;
|
||||||
|
mm_segment_t old_fs = get_fs();
|
||||||
|
|
||||||
|
if(isRead)
|
||||||
|
fp = filp_open(path,O_RDONLY,S_IRUSR);
|
||||||
|
else
|
||||||
|
fp = filp_open(path,O_CREAT|O_WRONLY,S_IRUSR);
|
||||||
|
|
||||||
|
if (IS_ERR(fp)) {
|
||||||
|
bes_err("BES2600 : can't open %s\n", path);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (isRead) {
|
||||||
|
fp->f_pos = 0;
|
||||||
|
set_fs(KERNEL_DS);
|
||||||
|
ret = vfs_read(fp,buffer,size,&fp->f_pos);
|
||||||
|
set_fs(old_fs);
|
||||||
|
} else {
|
||||||
|
fp->f_pos = 0;
|
||||||
|
set_fs(KERNEL_DS);
|
||||||
|
ret = vfs_write(fp,buffer,size,&fp->f_pos);
|
||||||
|
set_fs(old_fs);
|
||||||
|
}
|
||||||
|
filp_close(fp,NULL);
|
||||||
|
|
||||||
|
bes_info("BES2600 : access_file return code(%d)\n", ret);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
int bes2600_wifi_start(struct bes2600_common *hw_priv)
|
int bes2600_wifi_start(struct bes2600_common *hw_priv)
|
||||||
{
|
{
|
||||||
int ret = 0, if_id;
|
int ret = 0, if_id;
|
||||||
|
|||||||
+1
-72
@@ -14,63 +14,11 @@
|
|||||||
#include "scan.h"
|
#include "scan.h"
|
||||||
#include "sta.h"
|
#include "sta.h"
|
||||||
#include "pm.h"
|
#include "pm.h"
|
||||||
#include "epta_coex.h"
|
|
||||||
#include "epta_request.h"
|
#include "epta_request.h"
|
||||||
#include "bes_pwr.h"
|
#include "bes_pwr.h"
|
||||||
|
|
||||||
/*
|
|
||||||
* After this many consecutive WSM scan rejections from firmware, stop
|
|
||||||
* issuing new scans for BES2600_SCAN_BACKOFF_JIFFIES and let the state
|
|
||||||
* that's rejecting them (coex window, firmware-internal busy) clear.
|
|
||||||
*
|
|
||||||
* The backoff has to be at least as long as the natural mac80211 scan-
|
|
||||||
* retry cadence, otherwise the next attempt lands outside the window
|
|
||||||
* and bypasses the defer guard. Observed in the wild on PineTab2:
|
|
||||||
* roam-evaluation bursts at ~12 s cadence, idle background scans at
|
|
||||||
* ~5 min cadence. 30 s catches the burst and leaves the slow case
|
|
||||||
* alone (the firmware-policy state has had minutes to clear by then
|
|
||||||
* anyway).
|
|
||||||
*/
|
|
||||||
#define BES2600_SCAN_REJECT_THRESHOLD 3
|
|
||||||
#define BES2600_SCAN_BACKOFF_JIFFIES (30 * HZ)
|
|
||||||
|
|
||||||
static void bes2600_scan_restart_delayed(struct bes2600_vif *priv);
|
static void bes2600_scan_restart_delayed(struct bes2600_vif *priv);
|
||||||
|
|
||||||
/*
|
|
||||||
* Decide whether to skip sending the next WSM scan command without
|
|
||||||
* bothering the firmware. Two triggers:
|
|
||||||
*
|
|
||||||
* 1. BT A2DP is streaming in non-FDD coex mode. The firmware is
|
|
||||||
* known to reject scan requests during that window; short-
|
|
||||||
* circuiting here saves a WSM round-trip and avoids the
|
|
||||||
* wsm_generic_confirm / scan_work warning cascade that follows.
|
|
||||||
*
|
|
||||||
* 2. We already saw >= BES2600_SCAN_REJECT_THRESHOLD consecutive
|
|
||||||
* rejections on recent scan attempts and the backoff window has
|
|
||||||
* not yet elapsed. Whatever was rejecting them is likely still
|
|
||||||
* rejecting them; give it time. If the backoff has elapsed without
|
|
||||||
* a fresh reject refreshing it, the burst is over and we reset the
|
|
||||||
* count so an isolated reject doesn't immediately re-trip.
|
|
||||||
*
|
|
||||||
* Returns true if the caller should abandon the scan iteration.
|
|
||||||
*/
|
|
||||||
static bool bes2600_scan_should_defer(struct bes2600_common *hw_priv)
|
|
||||||
{
|
|
||||||
#ifdef WIFI_BT_COEXIST_EPTA_ENABLE
|
|
||||||
if (!coex_is_fdd_mode() && coex_is_bt_a2dp())
|
|
||||||
return true;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
if (time_after(jiffies, hw_priv->scan.backoff_until))
|
|
||||||
hw_priv->scan.reject_count = 0;
|
|
||||||
|
|
||||||
if (hw_priv->scan.reject_count >= BES2600_SCAN_REJECT_THRESHOLD &&
|
|
||||||
time_before(jiffies, hw_priv->scan.backoff_until))
|
|
||||||
return true;
|
|
||||||
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifdef CONFIG_BES2600_TESTMODE
|
#ifdef CONFIG_BES2600_TESTMODE
|
||||||
static int bes2600_advance_scan_start(struct bes2600_common *hw_priv)
|
static int bes2600_advance_scan_start(struct bes2600_common *hw_priv)
|
||||||
{
|
{
|
||||||
@@ -754,29 +702,10 @@ void bes2600_scan_work(struct work_struct *work)
|
|||||||
wsm_unlock_tx(hw_priv);
|
wsm_unlock_tx(hw_priv);
|
||||||
} else
|
} else
|
||||||
#endif
|
#endif
|
||||||
{
|
|
||||||
if (bes2600_scan_should_defer(hw_priv)) {
|
|
||||||
hw_priv->scan.status = -EBUSY;
|
|
||||||
hw_priv->scan.reject_count++;
|
|
||||||
hw_priv->scan.backoff_until =
|
|
||||||
jiffies + BES2600_SCAN_BACKOFF_JIFFIES;
|
|
||||||
wiphy_dbg(priv->hw->wiphy,
|
|
||||||
"[SCAN] deferred (coex/backoff, reject_count=%u)\n",
|
|
||||||
hw_priv->scan.reject_count);
|
|
||||||
kfree(scan.ch);
|
|
||||||
goto fail;
|
|
||||||
}
|
|
||||||
hw_priv->scan.status = bes2600_scan_start(priv, &scan);
|
hw_priv->scan.status = bes2600_scan_start(priv, &scan);
|
||||||
}
|
|
||||||
kfree(scan.ch);
|
kfree(scan.ch);
|
||||||
if (hw_priv->scan.status) {
|
if (WARN_ON(hw_priv->scan.status))
|
||||||
hw_priv->scan.reject_count++;
|
|
||||||
hw_priv->scan.backoff_until =
|
|
||||||
jiffies + BES2600_SCAN_BACKOFF_JIFFIES;
|
|
||||||
/* Lower callers already logged the reason at wiphy_warn. */
|
|
||||||
goto fail;
|
goto fail;
|
||||||
}
|
|
||||||
hw_priv->scan.reject_count = 0;
|
|
||||||
hw_priv->scan.curr = it;
|
hw_priv->scan.curr = it;
|
||||||
}
|
}
|
||||||
up(&hw_priv->conf_lock);
|
up(&hw_priv->conf_lock);
|
||||||
|
|||||||
@@ -42,17 +42,6 @@ struct bes2600_scan {
|
|||||||
struct delayed_work probe_work;
|
struct delayed_work probe_work;
|
||||||
int direct_probe;
|
int direct_probe;
|
||||||
u8 if_id;
|
u8 if_id;
|
||||||
/*
|
|
||||||
* Track consecutive firmware-side WSM scan rejections so we can
|
|
||||||
* back off briefly instead of re-issuing the same scan on every
|
|
||||||
* mac80211 background-scan tick. Firmware returns WSM status != 0
|
|
||||||
* for a handful of transient conditions (BT A2DP active in non-
|
|
||||||
* FDD coex, firmware-internal busy windows) and keeps rejecting
|
|
||||||
* until the state clears; retrying at full cadence just floods
|
|
||||||
* dmesg.
|
|
||||||
*/
|
|
||||||
unsigned int reject_count;
|
|
||||||
unsigned long backoff_until;
|
|
||||||
};
|
};
|
||||||
|
|
||||||
int bes2600_hw_scan(struct ieee80211_hw *hw,
|
int bes2600_hw_scan(struct ieee80211_hw *hw,
|
||||||
|
|||||||
+1
-13
@@ -134,20 +134,8 @@ static int wsm_generic_confirm(struct bes2600_common *hw_priv,
|
|||||||
struct wsm_buf *buf)
|
struct wsm_buf *buf)
|
||||||
{
|
{
|
||||||
u32 status = WSM_GET32(buf);
|
u32 status = WSM_GET32(buf);
|
||||||
|
if (WARN(status != WSM_STATUS_SUCCESS, "wsm_generic_confirm ret %u", status))
|
||||||
/*
|
|
||||||
* A non-SUCCESS status here is a firmware-side policy decision for
|
|
||||||
* the command whose confirm this is -- commonly WSM status 2 for
|
|
||||||
* scan (0x0407) rejected because of a coex window or transient
|
|
||||||
* firmware-busy state. It is not a driver/kernel bug, so avoid the
|
|
||||||
* WARN()/stack-trace treatment; the caller already emits a
|
|
||||||
* wiphy_warn identifying the request id and will propagate the
|
|
||||||
* error to mac80211.
|
|
||||||
*/
|
|
||||||
if (status != WSM_STATUS_SUCCESS) {
|
|
||||||
bes_devel("%s ret %u\n", __func__, status);
|
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
}
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
underflow:
|
underflow:
|
||||||
|
|||||||
Vendored
+2
-1
@@ -18,7 +18,8 @@ License: LGPL-2.1
|
|||||||
License for more details.
|
License for more details.
|
||||||
.
|
.
|
||||||
You should have received a copy of the GNU Lesser General Public License
|
You should have received a copy of the GNU Lesser General Public License
|
||||||
along with this library; if not, see <https://www.gnu.org/licenses/>.
|
along with this library; if not, write to the Free Software Foundation, Inc.,
|
||||||
|
51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
||||||
.
|
.
|
||||||
On Debian systems, the full text of the GNU Lesser General Public License
|
On Debian systems, the full text of the GNU Lesser General Public License
|
||||||
version 2.1 can be found in the file "/usr/share/common-licenses/LGPL-2.1".
|
version 2.1 can be found in the file "/usr/share/common-licenses/LGPL-2.1".
|
||||||
|
|||||||
Reference in New Issue
Block a user