1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /* Copyright (C) 2009 - 2010 Ivo van Doorn <IvDoorn@gmail.com>
3 * Copyright (C) 2009 Alban Browaeys <prahal@yahoo.com>
4 * Copyright (C) 2009 Felix Fietkau <nbd@openwrt.org>
5 * Copyright (C) 2009 Luis Correia <luis.f.correia@gmail.com>
6 * Copyright (C) 2009 Mattias Nissler <mattias.nissler@gmx.de>
7 * Copyright (C) 2009 Mark Asselstine <asselsm@gmail.com>
8 * Copyright (C) 2009 Xose Vazquez Perez <xose.vazquez@gmail.com>
9 * Copyright (C) 2009 Bart Zolnierkiewicz <bzolnier@gmail.com>
10 * <http://rt2x00.serialmonkey.com>
11 */
12
13 /* Module: rt2800soc
14 * Abstract: rt2800 WiSoC specific routines.
15 */
16
17 #include <linux/etherdevice.h>
18 #include <linux/init.h>
19 #include <linux/kernel.h>
20 #include <linux/module.h>
21 #include <linux/of.h>
22 #include <linux/platform_device.h>
23
24 #include "rt2x00.h"
25 #include "rt2x00mmio.h"
26 #include "rt2800.h"
27 #include "rt2800lib.h"
28 #include "rt2800mmio.h"
29
30 /* Allow hardware encryption to be disabled. */
31 static bool modparam_nohwcrypt;
32 module_param_named(nohwcrypt, modparam_nohwcrypt, bool, 0444);
33 MODULE_PARM_DESC(nohwcrypt, "Disable hardware encryption.");
34
rt2800soc_hwcrypt_disabled(struct rt2x00_dev * rt2x00dev)35 static bool rt2800soc_hwcrypt_disabled(struct rt2x00_dev *rt2x00dev)
36 {
37 return modparam_nohwcrypt;
38 }
39
rt2800soc_disable_radio(struct rt2x00_dev * rt2x00dev)40 static void rt2800soc_disable_radio(struct rt2x00_dev *rt2x00dev)
41 {
42 u32 reg;
43
44 rt2800_disable_radio(rt2x00dev);
45 rt2x00mmio_register_write(rt2x00dev, PWR_PIN_CFG, 0);
46
47 reg = 0;
48 if (rt2x00_rt(rt2x00dev, RT3883))
49 rt2x00_set_field32(®, TX_PIN_CFG_RFTR_EN, 1);
50
51 rt2x00mmio_register_write(rt2x00dev, TX_PIN_CFG, reg);
52 }
53
rt2800soc_set_device_state(struct rt2x00_dev * rt2x00dev,enum dev_state state)54 static int rt2800soc_set_device_state(struct rt2x00_dev *rt2x00dev,
55 enum dev_state state)
56 {
57 int retval = 0;
58
59 switch (state) {
60 case STATE_RADIO_ON:
61 retval = rt2800mmio_enable_radio(rt2x00dev);
62 break;
63
64 case STATE_RADIO_OFF:
65 rt2800soc_disable_radio(rt2x00dev);
66 break;
67
68 case STATE_RADIO_IRQ_ON:
69 case STATE_RADIO_IRQ_OFF:
70 rt2800mmio_toggle_irq(rt2x00dev, state);
71 break;
72
73 case STATE_DEEP_SLEEP:
74 case STATE_SLEEP:
75 case STATE_STANDBY:
76 case STATE_AWAKE:
77 /* These states are not supported, but don't report an error */
78 retval = 0;
79 break;
80
81 default:
82 retval = -ENOTSUPP;
83 break;
84 }
85
86 if (unlikely(retval))
87 rt2x00_err(rt2x00dev, "Device failed to enter state %d (%d)\n",
88 state, retval);
89
90 return retval;
91 }
92
rt2800soc_read_eeprom(struct rt2x00_dev * rt2x00dev)93 static int rt2800soc_read_eeprom(struct rt2x00_dev *rt2x00dev)
94 {
95 void __iomem *base_addr = ioremap(0x1F040000, EEPROM_SIZE);
96
97 if (!base_addr)
98 return -ENOMEM;
99
100 memcpy_fromio(rt2x00dev->eeprom, base_addr, EEPROM_SIZE);
101
102 iounmap(base_addr);
103 return 0;
104 }
105
106 /* Firmware functions */
rt2800soc_get_firmware_name(struct rt2x00_dev * rt2x00dev)107 static char *rt2800soc_get_firmware_name(struct rt2x00_dev *rt2x00dev)
108 {
109 WARN_ON_ONCE(1);
110 return NULL;
111 }
112
rt2800soc_load_firmware(struct rt2x00_dev * rt2x00dev,const u8 * data,const size_t len)113 static int rt2800soc_load_firmware(struct rt2x00_dev *rt2x00dev,
114 const u8 *data, const size_t len)
115 {
116 WARN_ON_ONCE(1);
117 return 0;
118 }
119
rt2800soc_check_firmware(struct rt2x00_dev * rt2x00dev,const u8 * data,const size_t len)120 static int rt2800soc_check_firmware(struct rt2x00_dev *rt2x00dev,
121 const u8 *data, const size_t len)
122 {
123 WARN_ON_ONCE(1);
124 return 0;
125 }
126
rt2800soc_write_firmware(struct rt2x00_dev * rt2x00dev,const u8 * data,const size_t len)127 static int rt2800soc_write_firmware(struct rt2x00_dev *rt2x00dev,
128 const u8 *data, const size_t len)
129 {
130 WARN_ON_ONCE(1);
131 return 0;
132 }
133
134 #ifdef CONFIG_PM
rt2800soc_suspend(struct platform_device * pdev,pm_message_t state)135 static int rt2800soc_suspend(struct platform_device *pdev, pm_message_t state)
136 {
137 struct ieee80211_hw *hw = platform_get_drvdata(pdev);
138 struct rt2x00_dev *rt2x00dev = hw->priv;
139
140 return rt2x00lib_suspend(rt2x00dev);
141 }
142
rt2800soc_resume(struct platform_device * pdev)143 static int rt2800soc_resume(struct platform_device *pdev)
144 {
145 struct ieee80211_hw *hw = platform_get_drvdata(pdev);
146 struct rt2x00_dev *rt2x00dev = hw->priv;
147
148 return rt2x00lib_resume(rt2x00dev);
149 }
150 #endif /* CONFIG_PM */
151
152 static const struct ieee80211_ops rt2800soc_mac80211_ops = {
153 .add_chanctx = ieee80211_emulate_add_chanctx,
154 .remove_chanctx = ieee80211_emulate_remove_chanctx,
155 .change_chanctx = ieee80211_emulate_change_chanctx,
156 .switch_vif_chanctx = ieee80211_emulate_switch_vif_chanctx,
157 .tx = rt2x00mac_tx,
158 .wake_tx_queue = ieee80211_handle_wake_tx_queue,
159 .start = rt2x00mac_start,
160 .stop = rt2x00mac_stop,
161 .add_interface = rt2x00mac_add_interface,
162 .remove_interface = rt2x00mac_remove_interface,
163 .config = rt2x00mac_config,
164 .configure_filter = rt2x00mac_configure_filter,
165 .set_key = rt2x00mac_set_key,
166 .sw_scan_start = rt2x00mac_sw_scan_start,
167 .sw_scan_complete = rt2x00mac_sw_scan_complete,
168 .get_stats = rt2x00mac_get_stats,
169 .get_key_seq = rt2800_get_key_seq,
170 .set_rts_threshold = rt2800_set_rts_threshold,
171 .sta_add = rt2800_sta_add,
172 .sta_remove = rt2800_sta_remove,
173 .bss_info_changed = rt2x00mac_bss_info_changed,
174 .conf_tx = rt2800_conf_tx,
175 .get_tsf = rt2800_get_tsf,
176 .rfkill_poll = rt2x00mac_rfkill_poll,
177 .ampdu_action = rt2800_ampdu_action,
178 .flush = rt2x00mac_flush,
179 .get_survey = rt2800_get_survey,
180 .get_ringparam = rt2x00mac_get_ringparam,
181 .tx_frames_pending = rt2x00mac_tx_frames_pending,
182 .reconfig_complete = rt2x00mac_reconfig_complete,
183 };
184
185 static const struct rt2800_ops rt2800soc_rt2800_ops = {
186 .register_read = rt2x00mmio_register_read,
187 .register_read_lock = rt2x00mmio_register_read, /* same for SoCs */
188 .register_write = rt2x00mmio_register_write,
189 .register_write_lock = rt2x00mmio_register_write, /* same for SoCs */
190 .register_multiread = rt2x00mmio_register_multiread,
191 .register_multiwrite = rt2x00mmio_register_multiwrite,
192 .regbusy_read = rt2x00mmio_regbusy_read,
193 .read_eeprom = rt2800soc_read_eeprom,
194 .hwcrypt_disabled = rt2800soc_hwcrypt_disabled,
195 .drv_write_firmware = rt2800soc_write_firmware,
196 .drv_init_registers = rt2800mmio_init_registers,
197 .drv_get_txwi = rt2800mmio_get_txwi,
198 .drv_get_dma_done = rt2800mmio_get_dma_done,
199 };
200
201 static const struct rt2x00lib_ops rt2800soc_rt2x00_ops = {
202 .irq_handler = rt2800mmio_interrupt,
203 .txstatus_tasklet = rt2800mmio_txstatus_tasklet,
204 .pretbtt_tasklet = rt2800mmio_pretbtt_tasklet,
205 .tbtt_tasklet = rt2800mmio_tbtt_tasklet,
206 .rxdone_tasklet = rt2800mmio_rxdone_tasklet,
207 .autowake_tasklet = rt2800mmio_autowake_tasklet,
208 .probe_hw = rt2800mmio_probe_hw,
209 .get_firmware_name = rt2800soc_get_firmware_name,
210 .check_firmware = rt2800soc_check_firmware,
211 .load_firmware = rt2800soc_load_firmware,
212 .initialize = rt2x00mmio_initialize,
213 .uninitialize = rt2x00mmio_uninitialize,
214 .get_entry_state = rt2800mmio_get_entry_state,
215 .clear_entry = rt2800mmio_clear_entry,
216 .set_device_state = rt2800soc_set_device_state,
217 .rfkill_poll = rt2800_rfkill_poll,
218 .link_stats = rt2800_link_stats,
219 .reset_tuner = rt2800_reset_tuner,
220 .link_tuner = rt2800_link_tuner,
221 .gain_calibration = rt2800_gain_calibration,
222 .vco_calibration = rt2800_vco_calibration,
223 .watchdog = rt2800_watchdog,
224 .start_queue = rt2800mmio_start_queue,
225 .kick_queue = rt2800mmio_kick_queue,
226 .stop_queue = rt2800mmio_stop_queue,
227 .flush_queue = rt2800mmio_flush_queue,
228 .write_tx_desc = rt2800mmio_write_tx_desc,
229 .write_tx_data = rt2800_write_tx_data,
230 .write_beacon = rt2800_write_beacon,
231 .clear_beacon = rt2800_clear_beacon,
232 .fill_rxdone = rt2800mmio_fill_rxdone,
233 .config_shared_key = rt2800_config_shared_key,
234 .config_pairwise_key = rt2800_config_pairwise_key,
235 .config_filter = rt2800_config_filter,
236 .config_intf = rt2800_config_intf,
237 .config_erp = rt2800_config_erp,
238 .config_ant = rt2800_config_ant,
239 .config = rt2800_config,
240 .pre_reset_hw = rt2800_pre_reset_hw,
241 };
242
243 static const struct rt2x00_ops rt2800soc_ops = {
244 .name = KBUILD_MODNAME,
245 .drv_data_size = sizeof(struct rt2800_drv_data),
246 .max_ap_intf = 8,
247 .eeprom_size = EEPROM_SIZE,
248 .rf_size = RF_SIZE,
249 .tx_queues = NUM_TX_QUEUES,
250 .queue_init = rt2800mmio_queue_init,
251 .lib = &rt2800soc_rt2x00_ops,
252 .drv = &rt2800soc_rt2800_ops,
253 .hw = &rt2800soc_mac80211_ops,
254 #ifdef CONFIG_RT2X00_LIB_DEBUGFS
255 .debugfs = &rt2800_rt2x00debug,
256 #endif /* CONFIG_RT2X00_LIB_DEBUGFS */
257 };
258
rt2x00soc_probe(struct platform_device * pdev,const struct rt2x00_ops * ops)259 static int rt2x00soc_probe(struct platform_device *pdev, const struct rt2x00_ops *ops)
260 {
261 struct rt2x00_dev *rt2x00dev;
262 struct ieee80211_hw *hw;
263 void __iomem *mem;
264 struct clk *clk;
265 __le16 *eeprom;
266 int retval;
267 u32 *rf;
268 int irq;
269
270 mem = devm_platform_ioremap_resource(pdev, 0);
271 if (IS_ERR(mem))
272 return PTR_ERR(mem);
273
274 irq = platform_get_irq(pdev, 0);
275 if (irq < 0)
276 return irq;
277
278 clk = devm_clk_get_optional(&pdev->dev, NULL);
279 if (IS_ERR(clk))
280 return PTR_ERR(clk);
281
282 eeprom = devm_kzalloc(&pdev->dev, ops->eeprom_size, GFP_KERNEL);
283 if (!eeprom)
284 return -ENOMEM;
285
286 rf = devm_kzalloc(&pdev->dev, ops->rf_size, GFP_KERNEL);
287 if (!rf)
288 return -ENOMEM;
289
290 hw = ieee80211_alloc_hw(sizeof(struct rt2x00_dev), ops->hw);
291 if (!hw)
292 return dev_err_probe(&pdev->dev, -ENOMEM, "Failed to allocate hardware");
293
294 platform_set_drvdata(pdev, hw);
295
296 rt2x00dev = hw->priv;
297 rt2x00dev->dev = &pdev->dev;
298 rt2x00dev->ops = ops;
299 rt2x00dev->hw = hw;
300 rt2x00dev->irq = irq;
301 rt2x00dev->clk = clk;
302 rt2x00dev->eeprom = eeprom;
303 rt2x00dev->rf = rf;
304 rt2x00dev->name = pdev->dev.driver->name;
305 rt2x00dev->csr.base = mem;
306
307 rt2x00_set_chip_intf(rt2x00dev, RT2X00_CHIP_INTF_SOC);
308
309 retval = rt2x00lib_probe_dev(rt2x00dev);
310 if (retval)
311 goto exit_free_device;
312
313 return 0;
314
315 exit_free_device:
316 ieee80211_free_hw(hw);
317
318 return retval;
319 }
320
rt2800soc_probe(struct platform_device * pdev)321 static int rt2800soc_probe(struct platform_device *pdev)
322 {
323 return rt2x00soc_probe(pdev, &rt2800soc_ops);
324 }
325
rt2800soc_remove(struct platform_device * pdev)326 static void rt2800soc_remove(struct platform_device *pdev)
327 {
328 struct ieee80211_hw *hw = platform_get_drvdata(pdev);
329 struct rt2x00_dev *rt2x00dev = hw->priv;
330
331 /*
332 * Free all allocated data.
333 */
334 rt2x00lib_remove_dev(rt2x00dev);
335 ieee80211_free_hw(hw);
336 }
337
338 static const struct of_device_id rt2880_wmac_match[] = {
339 { .compatible = "ralink,rt2880-wifi" },
340 {},
341 };
342 MODULE_DEVICE_TABLE(of, rt2880_wmac_match);
343
344 static struct platform_driver rt2800soc_driver = {
345 .driver = {
346 .name = "rt2800_wmac",
347 .of_match_table = rt2880_wmac_match,
348 },
349 .probe = rt2800soc_probe,
350 .remove = rt2800soc_remove,
351 #ifdef CONFIG_PM
352 .suspend = rt2800soc_suspend,
353 .resume = rt2800soc_resume,
354 #endif
355 };
356
357 module_platform_driver(rt2800soc_driver);
358
359 MODULE_AUTHOR(DRV_PROJECT);
360 MODULE_VERSION(DRV_VERSION);
361 MODULE_DESCRIPTION("Ralink WiSoC Wireless LAN driver.");
362 MODULE_LICENSE("GPL");
363