This source file includes following definitions.
- mt76x0_init_usb_dma
- mt76x0u_cleanup
- mt76x0u_stop
- mt76x0u_start
- mt76x0u_init_hardware
- mt76x0u_register_device
- mt76x0u_probe
- mt76x0_disconnect
- mt76x0_suspend
- mt76x0_resume
1
2
3
4
5
6 #include <linux/kernel.h>
7 #include <linux/module.h>
8 #include <linux/usb.h>
9
10 #include "mt76x0.h"
11 #include "mcu.h"
12 #include "../mt76x02_usb.h"
13
14 static struct usb_device_id mt76x0_device_table[] = {
15 { USB_DEVICE(0x148F, 0x7610) },
16 { USB_DEVICE(0x13B1, 0x003E) },
17 { USB_DEVICE(0x0E8D, 0x7610) },
18 { USB_DEVICE(0x7392, 0xa711) },
19 { USB_DEVICE(0x7392, 0xb711) },
20 { USB_DEVICE(0x148f, 0x761a) },
21 { USB_DEVICE(0x148f, 0x760a) },
22 { USB_DEVICE(0x0b05, 0x17d1) },
23 { USB_DEVICE(0x0b05, 0x17db) },
24 { USB_DEVICE(0x0df6, 0x0075) },
25 { USB_DEVICE(0x2019, 0xab31) },
26 { USB_DEVICE(0x2001, 0x3d02) },
27 { USB_DEVICE(0x0586, 0x3425) },
28 { USB_DEVICE(0x07b8, 0x7610) },
29 { USB_DEVICE(0x04bb, 0x0951) },
30 { USB_DEVICE(0x057c, 0x8502) },
31 { USB_DEVICE(0x293c, 0x5702) },
32 { USB_DEVICE(0x20f4, 0x806b) },
33 { USB_DEVICE(0x7392, 0xc711) },
34 { USB_DEVICE(0x0df6, 0x0079) },
35 { USB_DEVICE(0x2357, 0x0123) },
36
37 { USB_DEVICE(0x2357, 0x0105), .driver_info = 1, },
38
39 { USB_DEVICE_AND_INTERFACE_INFO(0x0E8D, 0x7630, 0xff, 0x2, 0xff)},
40
41 { USB_DEVICE_AND_INTERFACE_INFO(0x0E8D, 0x7650, 0xff, 0x2, 0xff)},
42 { 0, }
43 };
44
45 static void mt76x0_init_usb_dma(struct mt76x02_dev *dev)
46 {
47 u32 val;
48
49 val = mt76_rr(dev, MT_USB_DMA_CFG);
50
51 val |= MT_USB_DMA_CFG_RX_BULK_EN |
52 MT_USB_DMA_CFG_TX_BULK_EN;
53
54
55
56
57 val &= ~MT_USB_DMA_CFG_RX_BULK_AGG_EN;
58 mt76_wr(dev, MT_USB_DMA_CFG, val);
59
60 val = mt76_rr(dev, MT_COM_REG0);
61 if (val & 1)
62 dev_dbg(dev->mt76.dev, "MCU not ready\n");
63
64 val = mt76_rr(dev, MT_USB_DMA_CFG);
65
66 val |= MT_USB_DMA_CFG_RX_DROP_OR_PAD;
67 mt76_wr(dev, MT_USB_DMA_CFG, val);
68 val &= ~MT_USB_DMA_CFG_RX_DROP_OR_PAD;
69 mt76_wr(dev, MT_USB_DMA_CFG, val);
70 }
71
72 static void mt76x0u_cleanup(struct mt76x02_dev *dev)
73 {
74 clear_bit(MT76_STATE_INITIALIZED, &dev->mt76.state);
75 mt76x0_chip_onoff(dev, false, false);
76 mt76u_queues_deinit(&dev->mt76);
77 }
78
79 static void mt76x0u_stop(struct ieee80211_hw *hw)
80 {
81 struct mt76x02_dev *dev = hw->priv;
82
83 clear_bit(MT76_STATE_RUNNING, &dev->mt76.state);
84 cancel_delayed_work_sync(&dev->cal_work);
85 cancel_delayed_work_sync(&dev->mt76.mac_work);
86 mt76u_stop_tx(&dev->mt76);
87 mt76x02u_exit_beacon_config(dev);
88
89 if (test_bit(MT76_REMOVED, &dev->mt76.state))
90 return;
91
92 if (!mt76_poll(dev, MT_USB_DMA_CFG, MT_USB_DMA_CFG_TX_BUSY, 0, 1000))
93 dev_warn(dev->mt76.dev, "TX DMA did not stop\n");
94
95 mt76x0_mac_stop(dev);
96
97 if (!mt76_poll(dev, MT_USB_DMA_CFG, MT_USB_DMA_CFG_RX_BUSY, 0, 1000))
98 dev_warn(dev->mt76.dev, "RX DMA did not stop\n");
99 }
100
101 static int mt76x0u_start(struct ieee80211_hw *hw)
102 {
103 struct mt76x02_dev *dev = hw->priv;
104 int ret;
105
106 ret = mt76x0_mac_start(dev);
107 if (ret)
108 return ret;
109
110 mt76x0_phy_calibrate(dev, true);
111 ieee80211_queue_delayed_work(dev->mt76.hw, &dev->mt76.mac_work,
112 MT_MAC_WORK_INTERVAL);
113 ieee80211_queue_delayed_work(dev->mt76.hw, &dev->cal_work,
114 MT_CALIBRATE_INTERVAL);
115 set_bit(MT76_STATE_RUNNING, &dev->mt76.state);
116 return 0;
117 }
118
119 static const struct ieee80211_ops mt76x0u_ops = {
120 .tx = mt76x02_tx,
121 .start = mt76x0u_start,
122 .stop = mt76x0u_stop,
123 .add_interface = mt76x02_add_interface,
124 .remove_interface = mt76x02_remove_interface,
125 .config = mt76x0_config,
126 .configure_filter = mt76x02_configure_filter,
127 .bss_info_changed = mt76x02_bss_info_changed,
128 .sta_state = mt76_sta_state,
129 .set_key = mt76x02_set_key,
130 .conf_tx = mt76x02_conf_tx,
131 .sw_scan_start = mt76_sw_scan,
132 .sw_scan_complete = mt76x02_sw_scan_complete,
133 .ampdu_action = mt76x02_ampdu_action,
134 .sta_rate_tbl_update = mt76x02_sta_rate_tbl_update,
135 .set_rts_threshold = mt76x02_set_rts_threshold,
136 .wake_tx_queue = mt76_wake_tx_queue,
137 .get_txpower = mt76_get_txpower,
138 .get_survey = mt76_get_survey,
139 .set_tim = mt76_set_tim,
140 .release_buffered_frames = mt76_release_buffered_frames,
141 };
142
143 static int mt76x0u_init_hardware(struct mt76x02_dev *dev, bool reset)
144 {
145 int err;
146
147 mt76x0_chip_onoff(dev, true, reset);
148
149 if (!mt76x02_wait_for_mac(&dev->mt76))
150 return -ETIMEDOUT;
151
152 err = mt76x0u_mcu_init(dev);
153 if (err < 0)
154 return err;
155
156 mt76x0_init_usb_dma(dev);
157 err = mt76x0_init_hardware(dev);
158 if (err < 0)
159 return err;
160
161 mt76x02u_init_beacon_config(dev);
162
163 mt76_rmw(dev, MT_US_CYC_CFG, MT_US_CYC_CNT, 0x1e);
164 mt76_wr(dev, MT_TXOP_CTRL_CFG,
165 FIELD_PREP(MT_TXOP_TRUN_EN, 0x3f) |
166 FIELD_PREP(MT_TXOP_EXT_CCA_DLY, 0x58));
167
168 mt76_wr(dev, MT_CH_TIME_CFG,
169 MT_CH_TIME_CFG_TIMER_EN |
170 MT_CH_TIME_CFG_TX_AS_BUSY |
171 MT_CH_TIME_CFG_RX_AS_BUSY |
172 MT_CH_TIME_CFG_NAV_AS_BUSY |
173 MT_CH_TIME_CFG_EIFS_AS_BUSY);
174
175 return 0;
176 }
177
178 static int mt76x0u_register_device(struct mt76x02_dev *dev)
179 {
180 struct ieee80211_hw *hw = dev->mt76.hw;
181 int err;
182
183 err = mt76u_alloc_queues(&dev->mt76);
184 if (err < 0)
185 goto out_err;
186
187 err = mt76x0u_init_hardware(dev, true);
188 if (err < 0)
189 goto out_err;
190
191 err = mt76x0_register_device(dev);
192 if (err < 0)
193 goto out_err;
194
195
196 if (dev->mt76.usb.sg_en)
197 hw->max_tx_fragments = MT_TX_SG_MAX_SIZE;
198 else
199 hw->max_tx_fragments = 1;
200
201 set_bit(MT76_STATE_INITIALIZED, &dev->mt76.state);
202
203 return 0;
204
205 out_err:
206 mt76x0u_cleanup(dev);
207 return err;
208 }
209
210 static int mt76x0u_probe(struct usb_interface *usb_intf,
211 const struct usb_device_id *id)
212 {
213 static const struct mt76_driver_ops drv_ops = {
214 .update_survey = mt76x02_update_channel,
215 .tx_prepare_skb = mt76x02u_tx_prepare_skb,
216 .tx_complete_skb = mt76x02u_tx_complete_skb,
217 .tx_status_data = mt76x02_tx_status_data,
218 .rx_skb = mt76x02_queue_rx_skb,
219 .sta_ps = mt76x02_sta_ps,
220 .sta_add = mt76x02_sta_add,
221 .sta_remove = mt76x02_sta_remove,
222 };
223 struct usb_device *usb_dev = interface_to_usbdev(usb_intf);
224 struct mt76x02_dev *dev;
225 struct mt76_dev *mdev;
226 u32 mac_rev;
227 int ret;
228
229 mdev = mt76_alloc_device(&usb_intf->dev, sizeof(*dev), &mt76x0u_ops,
230 &drv_ops);
231 if (!mdev)
232 return -ENOMEM;
233
234 dev = container_of(mdev, struct mt76x02_dev, mt76);
235 mutex_init(&dev->phy_mutex);
236
237
238 if (id->driver_info)
239 dev->no_2ghz = true;
240
241 usb_dev = usb_get_dev(usb_dev);
242 usb_reset_device(usb_dev);
243
244 usb_set_intfdata(usb_intf, dev);
245
246 mt76x02u_init_mcu(mdev);
247 ret = mt76u_init(mdev, usb_intf);
248 if (ret)
249 goto err;
250
251
252 mt76x0_chip_onoff(dev, false, false);
253
254 if (!mt76x02_wait_for_mac(mdev)) {
255 ret = -ETIMEDOUT;
256 goto err;
257 }
258
259 mdev->rev = mt76_rr(dev, MT_ASIC_VERSION);
260 mac_rev = mt76_rr(dev, MT_MAC_CSR0);
261 dev_info(mdev->dev, "ASIC revision: %08x MAC revision: %08x\n",
262 mdev->rev, mac_rev);
263 if (!is_mt76x0(dev)) {
264 ret = -ENODEV;
265 goto err;
266 }
267
268
269 if (!(mt76_rr(dev, MT_EFUSE_CTRL) & MT_EFUSE_CTRL_SEL))
270 dev_warn(mdev->dev, "Warning: eFUSE not present\n");
271
272 ret = mt76x0u_register_device(dev);
273 if (ret < 0)
274 goto err;
275
276 return 0;
277
278 err:
279 usb_set_intfdata(usb_intf, NULL);
280 usb_put_dev(interface_to_usbdev(usb_intf));
281
282 ieee80211_free_hw(mdev->hw);
283 return ret;
284 }
285
286 static void mt76x0_disconnect(struct usb_interface *usb_intf)
287 {
288 struct mt76x02_dev *dev = usb_get_intfdata(usb_intf);
289 bool initialized = test_bit(MT76_STATE_INITIALIZED, &dev->mt76.state);
290
291 if (!initialized)
292 return;
293
294 ieee80211_unregister_hw(dev->mt76.hw);
295 mt76x0u_cleanup(dev);
296
297 usb_set_intfdata(usb_intf, NULL);
298 usb_put_dev(interface_to_usbdev(usb_intf));
299
300 ieee80211_free_hw(dev->mt76.hw);
301 }
302
303 static int __maybe_unused mt76x0_suspend(struct usb_interface *usb_intf,
304 pm_message_t state)
305 {
306 struct mt76x02_dev *dev = usb_get_intfdata(usb_intf);
307
308 mt76u_stop_rx(&dev->mt76);
309 clear_bit(MT76_STATE_MCU_RUNNING, &dev->mt76.state);
310 mt76x0_chip_onoff(dev, false, false);
311
312 return 0;
313 }
314
315 static int __maybe_unused mt76x0_resume(struct usb_interface *usb_intf)
316 {
317 struct mt76x02_dev *dev = usb_get_intfdata(usb_intf);
318 int ret;
319
320 ret = mt76u_resume_rx(&dev->mt76);
321 if (ret < 0)
322 goto err;
323
324 ret = mt76x0u_init_hardware(dev, false);
325 if (ret)
326 goto err;
327
328 return 0;
329 err:
330 mt76x0u_cleanup(dev);
331 return ret;
332 }
333
334 MODULE_DEVICE_TABLE(usb, mt76x0_device_table);
335 MODULE_FIRMWARE(MT7610E_FIRMWARE);
336 MODULE_FIRMWARE(MT7610U_FIRMWARE);
337 MODULE_LICENSE("GPL");
338
339 static struct usb_driver mt76x0_driver = {
340 .name = KBUILD_MODNAME,
341 .id_table = mt76x0_device_table,
342 .probe = mt76x0u_probe,
343 .disconnect = mt76x0_disconnect,
344 .suspend = mt76x0_suspend,
345 .resume = mt76x0_resume,
346 .reset_resume = mt76x0_resume,
347 .soft_unbind = 1,
348 .disable_hub_initiated_lpm = 1,
349 };
350 module_usb_driver(mt76x0_driver);