mirror of
git://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
synced 2025-08-05 16:54:27 +00:00
ddc19499ae
Remove a bunch of static memory management functions and simplify with devm. Also move allocation before ieee80211_alloc_hw to get rid of goto statements and clarify the error handling a bit more. Signed-off-by: Rosen Penev <rosenp@gmail.com> Acked-by: Stanislaw Gruszka <stf_xl@wp.pl> Reviewed-by: Sergio Paracuellos <sergio.paracuellos@gmail.com> Link: https://patch.msgid.link/20250722212856.11343-6-rosenp@gmail.com Signed-off-by: Johannes Berg <johannes.berg@intel.com>
362 lines
9.8 KiB
C
362 lines
9.8 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/* Copyright (C) 2009 - 2010 Ivo van Doorn <IvDoorn@gmail.com>
|
|
* Copyright (C) 2009 Alban Browaeys <prahal@yahoo.com>
|
|
* Copyright (C) 2009 Felix Fietkau <nbd@openwrt.org>
|
|
* Copyright (C) 2009 Luis Correia <luis.f.correia@gmail.com>
|
|
* Copyright (C) 2009 Mattias Nissler <mattias.nissler@gmx.de>
|
|
* Copyright (C) 2009 Mark Asselstine <asselsm@gmail.com>
|
|
* Copyright (C) 2009 Xose Vazquez Perez <xose.vazquez@gmail.com>
|
|
* Copyright (C) 2009 Bart Zolnierkiewicz <bzolnier@gmail.com>
|
|
* <http://rt2x00.serialmonkey.com>
|
|
*/
|
|
|
|
/* Module: rt2800soc
|
|
* Abstract: rt2800 WiSoC specific routines.
|
|
*/
|
|
|
|
#include <linux/etherdevice.h>
|
|
#include <linux/init.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/platform_device.h>
|
|
|
|
#include "rt2x00.h"
|
|
#include "rt2x00mmio.h"
|
|
#include "rt2800.h"
|
|
#include "rt2800lib.h"
|
|
#include "rt2800mmio.h"
|
|
|
|
/* Allow hardware encryption to be disabled. */
|
|
static bool modparam_nohwcrypt;
|
|
module_param_named(nohwcrypt, modparam_nohwcrypt, bool, 0444);
|
|
MODULE_PARM_DESC(nohwcrypt, "Disable hardware encryption.");
|
|
|
|
static bool rt2800soc_hwcrypt_disabled(struct rt2x00_dev *rt2x00dev)
|
|
{
|
|
return modparam_nohwcrypt;
|
|
}
|
|
|
|
static void rt2800soc_disable_radio(struct rt2x00_dev *rt2x00dev)
|
|
{
|
|
u32 reg;
|
|
|
|
rt2800_disable_radio(rt2x00dev);
|
|
rt2x00mmio_register_write(rt2x00dev, PWR_PIN_CFG, 0);
|
|
|
|
reg = 0;
|
|
if (rt2x00_rt(rt2x00dev, RT3883))
|
|
rt2x00_set_field32(®, TX_PIN_CFG_RFTR_EN, 1);
|
|
|
|
rt2x00mmio_register_write(rt2x00dev, TX_PIN_CFG, reg);
|
|
}
|
|
|
|
static int rt2800soc_set_device_state(struct rt2x00_dev *rt2x00dev,
|
|
enum dev_state state)
|
|
{
|
|
int retval = 0;
|
|
|
|
switch (state) {
|
|
case STATE_RADIO_ON:
|
|
retval = rt2800mmio_enable_radio(rt2x00dev);
|
|
break;
|
|
|
|
case STATE_RADIO_OFF:
|
|
rt2800soc_disable_radio(rt2x00dev);
|
|
break;
|
|
|
|
case STATE_RADIO_IRQ_ON:
|
|
case STATE_RADIO_IRQ_OFF:
|
|
rt2800mmio_toggle_irq(rt2x00dev, state);
|
|
break;
|
|
|
|
case STATE_DEEP_SLEEP:
|
|
case STATE_SLEEP:
|
|
case STATE_STANDBY:
|
|
case STATE_AWAKE:
|
|
/* These states are not supported, but don't report an error */
|
|
retval = 0;
|
|
break;
|
|
|
|
default:
|
|
retval = -ENOTSUPP;
|
|
break;
|
|
}
|
|
|
|
if (unlikely(retval))
|
|
rt2x00_err(rt2x00dev, "Device failed to enter state %d (%d)\n",
|
|
state, retval);
|
|
|
|
return retval;
|
|
}
|
|
|
|
static int rt2800soc_read_eeprom(struct rt2x00_dev *rt2x00dev)
|
|
{
|
|
void __iomem *base_addr = ioremap(0x1F040000, EEPROM_SIZE);
|
|
|
|
if (!base_addr)
|
|
return -ENOMEM;
|
|
|
|
memcpy_fromio(rt2x00dev->eeprom, base_addr, EEPROM_SIZE);
|
|
|
|
iounmap(base_addr);
|
|
return 0;
|
|
}
|
|
|
|
/* Firmware functions */
|
|
static char *rt2800soc_get_firmware_name(struct rt2x00_dev *rt2x00dev)
|
|
{
|
|
WARN_ON_ONCE(1);
|
|
return NULL;
|
|
}
|
|
|
|
static int rt2800soc_load_firmware(struct rt2x00_dev *rt2x00dev,
|
|
const u8 *data, const size_t len)
|
|
{
|
|
WARN_ON_ONCE(1);
|
|
return 0;
|
|
}
|
|
|
|
static int rt2800soc_check_firmware(struct rt2x00_dev *rt2x00dev,
|
|
const u8 *data, const size_t len)
|
|
{
|
|
WARN_ON_ONCE(1);
|
|
return 0;
|
|
}
|
|
|
|
static int rt2800soc_write_firmware(struct rt2x00_dev *rt2x00dev,
|
|
const u8 *data, const size_t len)
|
|
{
|
|
WARN_ON_ONCE(1);
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int rt2800soc_suspend(struct platform_device *pdev, pm_message_t state)
|
|
{
|
|
struct ieee80211_hw *hw = platform_get_drvdata(pdev);
|
|
struct rt2x00_dev *rt2x00dev = hw->priv;
|
|
|
|
return rt2x00lib_suspend(rt2x00dev);
|
|
}
|
|
|
|
static int rt2800soc_resume(struct platform_device *pdev)
|
|
{
|
|
struct ieee80211_hw *hw = platform_get_drvdata(pdev);
|
|
struct rt2x00_dev *rt2x00dev = hw->priv;
|
|
|
|
return rt2x00lib_resume(rt2x00dev);
|
|
}
|
|
#endif /* CONFIG_PM */
|
|
|
|
static const struct ieee80211_ops rt2800soc_mac80211_ops = {
|
|
.add_chanctx = ieee80211_emulate_add_chanctx,
|
|
.remove_chanctx = ieee80211_emulate_remove_chanctx,
|
|
.change_chanctx = ieee80211_emulate_change_chanctx,
|
|
.switch_vif_chanctx = ieee80211_emulate_switch_vif_chanctx,
|
|
.tx = rt2x00mac_tx,
|
|
.wake_tx_queue = ieee80211_handle_wake_tx_queue,
|
|
.start = rt2x00mac_start,
|
|
.stop = rt2x00mac_stop,
|
|
.add_interface = rt2x00mac_add_interface,
|
|
.remove_interface = rt2x00mac_remove_interface,
|
|
.config = rt2x00mac_config,
|
|
.configure_filter = rt2x00mac_configure_filter,
|
|
.set_key = rt2x00mac_set_key,
|
|
.sw_scan_start = rt2x00mac_sw_scan_start,
|
|
.sw_scan_complete = rt2x00mac_sw_scan_complete,
|
|
.get_stats = rt2x00mac_get_stats,
|
|
.get_key_seq = rt2800_get_key_seq,
|
|
.set_rts_threshold = rt2800_set_rts_threshold,
|
|
.sta_add = rt2800_sta_add,
|
|
.sta_remove = rt2800_sta_remove,
|
|
.bss_info_changed = rt2x00mac_bss_info_changed,
|
|
.conf_tx = rt2800_conf_tx,
|
|
.get_tsf = rt2800_get_tsf,
|
|
.rfkill_poll = rt2x00mac_rfkill_poll,
|
|
.ampdu_action = rt2800_ampdu_action,
|
|
.flush = rt2x00mac_flush,
|
|
.get_survey = rt2800_get_survey,
|
|
.get_ringparam = rt2x00mac_get_ringparam,
|
|
.tx_frames_pending = rt2x00mac_tx_frames_pending,
|
|
.reconfig_complete = rt2x00mac_reconfig_complete,
|
|
};
|
|
|
|
static const struct rt2800_ops rt2800soc_rt2800_ops = {
|
|
.register_read = rt2x00mmio_register_read,
|
|
.register_read_lock = rt2x00mmio_register_read, /* same for SoCs */
|
|
.register_write = rt2x00mmio_register_write,
|
|
.register_write_lock = rt2x00mmio_register_write, /* same for SoCs */
|
|
.register_multiread = rt2x00mmio_register_multiread,
|
|
.register_multiwrite = rt2x00mmio_register_multiwrite,
|
|
.regbusy_read = rt2x00mmio_regbusy_read,
|
|
.read_eeprom = rt2800soc_read_eeprom,
|
|
.hwcrypt_disabled = rt2800soc_hwcrypt_disabled,
|
|
.drv_write_firmware = rt2800soc_write_firmware,
|
|
.drv_init_registers = rt2800mmio_init_registers,
|
|
.drv_get_txwi = rt2800mmio_get_txwi,
|
|
.drv_get_dma_done = rt2800mmio_get_dma_done,
|
|
};
|
|
|
|
static const struct rt2x00lib_ops rt2800soc_rt2x00_ops = {
|
|
.irq_handler = rt2800mmio_interrupt,
|
|
.txstatus_tasklet = rt2800mmio_txstatus_tasklet,
|
|
.pretbtt_tasklet = rt2800mmio_pretbtt_tasklet,
|
|
.tbtt_tasklet = rt2800mmio_tbtt_tasklet,
|
|
.rxdone_tasklet = rt2800mmio_rxdone_tasklet,
|
|
.autowake_tasklet = rt2800mmio_autowake_tasklet,
|
|
.probe_hw = rt2800mmio_probe_hw,
|
|
.get_firmware_name = rt2800soc_get_firmware_name,
|
|
.check_firmware = rt2800soc_check_firmware,
|
|
.load_firmware = rt2800soc_load_firmware,
|
|
.initialize = rt2x00mmio_initialize,
|
|
.uninitialize = rt2x00mmio_uninitialize,
|
|
.get_entry_state = rt2800mmio_get_entry_state,
|
|
.clear_entry = rt2800mmio_clear_entry,
|
|
.set_device_state = rt2800soc_set_device_state,
|
|
.rfkill_poll = rt2800_rfkill_poll,
|
|
.link_stats = rt2800_link_stats,
|
|
.reset_tuner = rt2800_reset_tuner,
|
|
.link_tuner = rt2800_link_tuner,
|
|
.gain_calibration = rt2800_gain_calibration,
|
|
.vco_calibration = rt2800_vco_calibration,
|
|
.watchdog = rt2800_watchdog,
|
|
.start_queue = rt2800mmio_start_queue,
|
|
.kick_queue = rt2800mmio_kick_queue,
|
|
.stop_queue = rt2800mmio_stop_queue,
|
|
.flush_queue = rt2800mmio_flush_queue,
|
|
.write_tx_desc = rt2800mmio_write_tx_desc,
|
|
.write_tx_data = rt2800_write_tx_data,
|
|
.write_beacon = rt2800_write_beacon,
|
|
.clear_beacon = rt2800_clear_beacon,
|
|
.fill_rxdone = rt2800mmio_fill_rxdone,
|
|
.config_shared_key = rt2800_config_shared_key,
|
|
.config_pairwise_key = rt2800_config_pairwise_key,
|
|
.config_filter = rt2800_config_filter,
|
|
.config_intf = rt2800_config_intf,
|
|
.config_erp = rt2800_config_erp,
|
|
.config_ant = rt2800_config_ant,
|
|
.config = rt2800_config,
|
|
.pre_reset_hw = rt2800_pre_reset_hw,
|
|
};
|
|
|
|
static const struct rt2x00_ops rt2800soc_ops = {
|
|
.name = KBUILD_MODNAME,
|
|
.drv_data_size = sizeof(struct rt2800_drv_data),
|
|
.max_ap_intf = 8,
|
|
.eeprom_size = EEPROM_SIZE,
|
|
.rf_size = RF_SIZE,
|
|
.tx_queues = NUM_TX_QUEUES,
|
|
.queue_init = rt2800mmio_queue_init,
|
|
.lib = &rt2800soc_rt2x00_ops,
|
|
.drv = &rt2800soc_rt2800_ops,
|
|
.hw = &rt2800soc_mac80211_ops,
|
|
#ifdef CONFIG_RT2X00_LIB_DEBUGFS
|
|
.debugfs = &rt2800_rt2x00debug,
|
|
#endif /* CONFIG_RT2X00_LIB_DEBUGFS */
|
|
};
|
|
|
|
static int rt2x00soc_probe(struct platform_device *pdev, const struct rt2x00_ops *ops)
|
|
{
|
|
struct rt2x00_dev *rt2x00dev;
|
|
struct ieee80211_hw *hw;
|
|
void __iomem *mem;
|
|
struct clk *clk;
|
|
__le16 *eeprom;
|
|
int retval;
|
|
u32 *rf;
|
|
int irq;
|
|
|
|
mem = devm_platform_ioremap_resource(pdev, 0);
|
|
if (IS_ERR(mem))
|
|
return PTR_ERR(mem);
|
|
|
|
irq = platform_get_irq(pdev, 0);
|
|
if (irq < 0)
|
|
return irq;
|
|
|
|
clk = devm_clk_get_optional(&pdev->dev, NULL);
|
|
if (IS_ERR(clk))
|
|
return PTR_ERR(clk);
|
|
|
|
eeprom = devm_kzalloc(&pdev->dev, ops->eeprom_size, GFP_KERNEL);
|
|
if (!eeprom)
|
|
return -ENOMEM;
|
|
|
|
rf = devm_kzalloc(&pdev->dev, ops->rf_size, GFP_KERNEL);
|
|
if (!rf)
|
|
return -ENOMEM;
|
|
|
|
hw = ieee80211_alloc_hw(sizeof(struct rt2x00_dev), ops->hw);
|
|
if (!hw)
|
|
return dev_err_probe(&pdev->dev, -ENOMEM, "Failed to allocate hardware");
|
|
|
|
platform_set_drvdata(pdev, hw);
|
|
|
|
rt2x00dev = hw->priv;
|
|
rt2x00dev->dev = &pdev->dev;
|
|
rt2x00dev->ops = ops;
|
|
rt2x00dev->hw = hw;
|
|
rt2x00dev->irq = irq;
|
|
rt2x00dev->clk = clk;
|
|
rt2x00dev->eeprom = eeprom;
|
|
rt2x00dev->rf = rf;
|
|
rt2x00dev->name = pdev->dev.driver->name;
|
|
rt2x00dev->csr.base = mem;
|
|
|
|
rt2x00_set_chip_intf(rt2x00dev, RT2X00_CHIP_INTF_SOC);
|
|
|
|
retval = rt2x00lib_probe_dev(rt2x00dev);
|
|
if (retval)
|
|
goto exit_free_device;
|
|
|
|
return 0;
|
|
|
|
exit_free_device:
|
|
ieee80211_free_hw(hw);
|
|
|
|
return retval;
|
|
}
|
|
|
|
static int rt2800soc_probe(struct platform_device *pdev)
|
|
{
|
|
return rt2x00soc_probe(pdev, &rt2800soc_ops);
|
|
}
|
|
|
|
static void rt2800soc_remove(struct platform_device *pdev)
|
|
{
|
|
struct ieee80211_hw *hw = platform_get_drvdata(pdev);
|
|
struct rt2x00_dev *rt2x00dev = hw->priv;
|
|
|
|
/*
|
|
* Free all allocated data.
|
|
*/
|
|
rt2x00lib_remove_dev(rt2x00dev);
|
|
ieee80211_free_hw(hw);
|
|
}
|
|
|
|
static const struct of_device_id rt2880_wmac_match[] = {
|
|
{ .compatible = "ralink,rt2880-wifi" },
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, rt2880_wmac_match);
|
|
|
|
static struct platform_driver rt2800soc_driver = {
|
|
.driver = {
|
|
.name = "rt2800_wmac",
|
|
.of_match_table = rt2880_wmac_match,
|
|
},
|
|
.probe = rt2800soc_probe,
|
|
.remove = rt2800soc_remove,
|
|
#ifdef CONFIG_PM
|
|
.suspend = rt2800soc_suspend,
|
|
.resume = rt2800soc_resume,
|
|
#endif
|
|
};
|
|
|
|
module_platform_driver(rt2800soc_driver);
|
|
|
|
MODULE_AUTHOR(DRV_PROJECT);
|
|
MODULE_VERSION(DRV_VERSION);
|
|
MODULE_DESCRIPTION("Ralink WiSoC Wireless LAN driver.");
|
|
MODULE_LICENSE("GPL");
|