Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (C) 2015 Jakub Kicinski <kubakici@wp.pl>
4 */
5
6#include <linux/kernel.h>
7#include <linux/module.h>
8#include <linux/usb.h>
9
10#include "mt7601u.h"
11#include "usb.h"
12#include "trace.h"
13
14static const struct usb_device_id mt7601u_device_table[] = {
15 { USB_DEVICE(0x0b05, 0x17d3) },
16 { USB_DEVICE(0x0e8d, 0x760a) },
17 { USB_DEVICE(0x0e8d, 0x760b) },
18 { USB_DEVICE(0x13d3, 0x3431) },
19 { USB_DEVICE(0x13d3, 0x3434) },
20 { USB_DEVICE(0x148f, 0x7601) },
21 { USB_DEVICE(0x148f, 0x760a) },
22 { USB_DEVICE(0x148f, 0x760b) },
23 { USB_DEVICE(0x148f, 0x760c) },
24 { USB_DEVICE(0x148f, 0x760d) },
25 { USB_DEVICE(0x2001, 0x3d04) },
26 { USB_DEVICE(0x2717, 0x4106) },
27 { USB_DEVICE(0x2955, 0x0001) },
28 { USB_DEVICE(0x2955, 0x1001) },
29 { USB_DEVICE(0x2955, 0x1003) },
30 { USB_DEVICE(0x2a5f, 0x1000) },
31 { USB_DEVICE(0x7392, 0x7710) },
32 { 0, }
33};
34
35bool mt7601u_usb_alloc_buf(struct mt7601u_dev *dev, size_t len,
36 struct mt7601u_dma_buf *buf)
37{
38 struct usb_device *usb_dev = mt7601u_to_usb_dev(dev);
39
40 buf->len = len;
41 buf->urb = usb_alloc_urb(0, GFP_KERNEL);
42 buf->buf = usb_alloc_coherent(usb_dev, buf->len, GFP_KERNEL, &buf->dma);
43
44 return !buf->urb || !buf->buf;
45}
46
47void mt7601u_usb_free_buf(struct mt7601u_dev *dev, struct mt7601u_dma_buf *buf)
48{
49 struct usb_device *usb_dev = mt7601u_to_usb_dev(dev);
50
51 usb_free_coherent(usb_dev, buf->len, buf->buf, buf->dma);
52 usb_free_urb(buf->urb);
53}
54
55int mt7601u_usb_submit_buf(struct mt7601u_dev *dev, int dir, int ep_idx,
56 struct mt7601u_dma_buf *buf, gfp_t gfp,
57 usb_complete_t complete_fn, void *context)
58{
59 struct usb_device *usb_dev = mt7601u_to_usb_dev(dev);
60 unsigned pipe;
61 int ret;
62
63 if (dir == USB_DIR_IN)
64 pipe = usb_rcvbulkpipe(usb_dev, dev->in_eps[ep_idx]);
65 else
66 pipe = usb_sndbulkpipe(usb_dev, dev->out_eps[ep_idx]);
67
68 usb_fill_bulk_urb(buf->urb, usb_dev, pipe, buf->buf, buf->len,
69 complete_fn, context);
70 buf->urb->transfer_dma = buf->dma;
71 buf->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
72
73 trace_mt_submit_urb(dev, buf->urb);
74 ret = usb_submit_urb(buf->urb, gfp);
75 if (ret)
76 dev_err(dev->dev, "Error: submit URB dir:%d ep:%d failed:%d\n",
77 dir, ep_idx, ret);
78 return ret;
79}
80
81void mt7601u_complete_urb(struct urb *urb)
82{
83 struct completion *cmpl = urb->context;
84
85 complete(cmpl);
86}
87
88int mt7601u_vendor_request(struct mt7601u_dev *dev, const u8 req,
89 const u8 direction, const u16 val, const u16 offset,
90 void *buf, const size_t buflen)
91{
92 int i, ret;
93 struct usb_device *usb_dev = mt7601u_to_usb_dev(dev);
94 const u8 req_type = direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE;
95 const unsigned int pipe = (direction == USB_DIR_IN) ?
96 usb_rcvctrlpipe(usb_dev, 0) : usb_sndctrlpipe(usb_dev, 0);
97
98 for (i = 0; i < MT_VEND_REQ_MAX_RETRY; i++) {
99 ret = usb_control_msg(usb_dev, pipe, req, req_type,
100 val, offset, buf, buflen,
101 MT_VEND_REQ_TOUT_MS);
102 trace_mt_vend_req(dev, pipe, req, req_type, val, offset,
103 buf, buflen, ret);
104
105 if (ret == -ENODEV)
106 set_bit(MT7601U_STATE_REMOVED, &dev->state);
107 if (ret >= 0 || ret == -ENODEV)
108 return ret;
109
110 msleep(5);
111 }
112
113 dev_err(dev->dev, "Vendor request req:%02x off:%04x failed:%d\n",
114 req, offset, ret);
115
116 return ret;
117}
118
119void mt7601u_vendor_reset(struct mt7601u_dev *dev)
120{
121 mt7601u_vendor_request(dev, MT_VEND_DEV_MODE, USB_DIR_OUT,
122 MT_VEND_DEV_MODE_RESET, 0, NULL, 0);
123}
124
125/* should be called with vendor_req_mutex held */
126static u32 __mt7601u_rr(struct mt7601u_dev *dev, u32 offset)
127{
128 int ret;
129 u32 val = ~0;
130
131 WARN_ONCE(offset > USHRT_MAX, "read high off:%08x", offset);
132
133 ret = mt7601u_vendor_request(dev, MT_VEND_MULTI_READ, USB_DIR_IN,
134 0, offset, dev->vend_buf, MT_VEND_BUF);
135 if (ret == MT_VEND_BUF)
136 val = get_unaligned_le32(dev->vend_buf);
137 else if (ret > 0)
138 dev_err(dev->dev, "Error: wrong size read:%d off:%08x\n",
139 ret, offset);
140
141 trace_reg_read(dev, offset, val);
142 return val;
143}
144
145u32 mt7601u_rr(struct mt7601u_dev *dev, u32 offset)
146{
147 u32 ret;
148
149 mutex_lock(&dev->vendor_req_mutex);
150 ret = __mt7601u_rr(dev, offset);
151 mutex_unlock(&dev->vendor_req_mutex);
152
153 return ret;
154}
155
156/* should be called with vendor_req_mutex held */
157static int __mt7601u_vendor_single_wr(struct mt7601u_dev *dev, const u8 req,
158 const u16 offset, const u32 val)
159{
160 int ret = mt7601u_vendor_request(dev, req, USB_DIR_OUT,
161 val & 0xffff, offset, NULL, 0);
162 if (!ret)
163 ret = mt7601u_vendor_request(dev, req, USB_DIR_OUT,
164 val >> 16, offset + 2, NULL, 0);
165 trace_reg_write(dev, offset, val);
166 return ret;
167}
168
169int mt7601u_vendor_single_wr(struct mt7601u_dev *dev, const u8 req,
170 const u16 offset, const u32 val)
171{
172 int ret;
173
174 mutex_lock(&dev->vendor_req_mutex);
175 ret = __mt7601u_vendor_single_wr(dev, req, offset, val);
176 mutex_unlock(&dev->vendor_req_mutex);
177
178 return ret;
179}
180
181void mt7601u_wr(struct mt7601u_dev *dev, u32 offset, u32 val)
182{
183 WARN_ONCE(offset > USHRT_MAX, "write high off:%08x", offset);
184
185 mt7601u_vendor_single_wr(dev, MT_VEND_WRITE, offset, val);
186}
187
188u32 mt7601u_rmw(struct mt7601u_dev *dev, u32 offset, u32 mask, u32 val)
189{
190 mutex_lock(&dev->vendor_req_mutex);
191 val |= __mt7601u_rr(dev, offset) & ~mask;
192 __mt7601u_vendor_single_wr(dev, MT_VEND_WRITE, offset, val);
193 mutex_unlock(&dev->vendor_req_mutex);
194
195 return val;
196}
197
198u32 mt7601u_rmc(struct mt7601u_dev *dev, u32 offset, u32 mask, u32 val)
199{
200 u32 reg;
201
202 mutex_lock(&dev->vendor_req_mutex);
203 reg = __mt7601u_rr(dev, offset);
204 val |= reg & ~mask;
205 if (reg != val)
206 __mt7601u_vendor_single_wr(dev, MT_VEND_WRITE,
207 offset, val);
208 mutex_unlock(&dev->vendor_req_mutex);
209
210 return val;
211}
212
213void mt7601u_wr_copy(struct mt7601u_dev *dev, u32 offset,
214 const void *data, int len)
215{
216 WARN_ONCE(offset & 3, "unaligned write copy off:%08x", offset);
217 WARN_ONCE(len & 3, "short write copy off:%08x", offset);
218
219 mt7601u_burst_write_regs(dev, offset, data, len / 4);
220}
221
222void mt7601u_addr_wr(struct mt7601u_dev *dev, const u32 offset, const u8 *addr)
223{
224 mt7601u_wr(dev, offset, get_unaligned_le32(addr));
225 mt7601u_wr(dev, offset + 4, addr[4] | addr[5] << 8);
226}
227
228static int mt7601u_assign_pipes(struct usb_interface *usb_intf,
229 struct mt7601u_dev *dev)
230{
231 struct usb_endpoint_descriptor *ep_desc;
232 struct usb_host_interface *intf_desc = usb_intf->cur_altsetting;
233 unsigned i, ep_i = 0, ep_o = 0;
234
235 BUILD_BUG_ON(sizeof(dev->in_eps) < __MT_EP_IN_MAX);
236 BUILD_BUG_ON(sizeof(dev->out_eps) < __MT_EP_OUT_MAX);
237
238 for (i = 0; i < intf_desc->desc.bNumEndpoints; i++) {
239 ep_desc = &intf_desc->endpoint[i].desc;
240
241 if (usb_endpoint_is_bulk_in(ep_desc) &&
242 ep_i++ < __MT_EP_IN_MAX) {
243 dev->in_eps[ep_i - 1] = usb_endpoint_num(ep_desc);
244 dev->in_max_packet = usb_endpoint_maxp(ep_desc);
245 /* Note: this is ignored by usb sub-system but vendor
246 * code does it. We can drop this at some point.
247 */
248 dev->in_eps[ep_i - 1] |= USB_DIR_IN;
249 } else if (usb_endpoint_is_bulk_out(ep_desc) &&
250 ep_o++ < __MT_EP_OUT_MAX) {
251 dev->out_eps[ep_o - 1] = usb_endpoint_num(ep_desc);
252 dev->out_max_packet = usb_endpoint_maxp(ep_desc);
253 }
254 }
255
256 if (ep_i != __MT_EP_IN_MAX || ep_o != __MT_EP_OUT_MAX) {
257 dev_err(dev->dev, "Error: wrong pipe number in:%d out:%d\n",
258 ep_i, ep_o);
259 return -EINVAL;
260 }
261
262 return 0;
263}
264
265static int mt7601u_probe(struct usb_interface *usb_intf,
266 const struct usb_device_id *id)
267{
268 struct usb_device *usb_dev = interface_to_usbdev(usb_intf);
269 struct mt7601u_dev *dev;
270 u32 asic_rev, mac_rev;
271 int ret;
272
273 dev = mt7601u_alloc_device(&usb_intf->dev);
274 if (!dev)
275 return -ENOMEM;
276
277 usb_dev = usb_get_dev(usb_dev);
278 usb_reset_device(usb_dev);
279
280 usb_set_intfdata(usb_intf, dev);
281
282 dev->vend_buf = devm_kmalloc(dev->dev, MT_VEND_BUF, GFP_KERNEL);
283 if (!dev->vend_buf) {
284 ret = -ENOMEM;
285 goto err;
286 }
287
288 ret = mt7601u_assign_pipes(usb_intf, dev);
289 if (ret)
290 goto err;
291 ret = mt7601u_wait_asic_ready(dev);
292 if (ret)
293 goto err;
294
295 asic_rev = mt7601u_rr(dev, MT_ASIC_VERSION);
296 mac_rev = mt7601u_rr(dev, MT_MAC_CSR0);
297 dev_info(dev->dev, "ASIC revision: %08x MAC revision: %08x\n",
298 asic_rev, mac_rev);
299 if ((asic_rev >> 16) != 0x7601) {
300 ret = -ENODEV;
301 goto err;
302 }
303
304 /* Note: vendor driver skips this check for MT7601U */
305 if (!(mt7601u_rr(dev, MT_EFUSE_CTRL) & MT_EFUSE_CTRL_SEL))
306 dev_warn(dev->dev, "Warning: eFUSE not present\n");
307
308 ret = mt7601u_init_hardware(dev);
309 if (ret)
310 goto err;
311 ret = mt7601u_register_device(dev);
312 if (ret)
313 goto err_hw;
314
315 set_bit(MT7601U_STATE_INITIALIZED, &dev->state);
316
317 return 0;
318err_hw:
319 mt7601u_cleanup(dev);
320err:
321 usb_set_intfdata(usb_intf, NULL);
322 usb_put_dev(interface_to_usbdev(usb_intf));
323
324 destroy_workqueue(dev->stat_wq);
325 ieee80211_free_hw(dev->hw);
326 return ret;
327}
328
329static void mt7601u_disconnect(struct usb_interface *usb_intf)
330{
331 struct mt7601u_dev *dev = usb_get_intfdata(usb_intf);
332
333 ieee80211_unregister_hw(dev->hw);
334 mt7601u_cleanup(dev);
335
336 usb_set_intfdata(usb_intf, NULL);
337 usb_put_dev(interface_to_usbdev(usb_intf));
338
339 destroy_workqueue(dev->stat_wq);
340 ieee80211_free_hw(dev->hw);
341}
342
343static int mt7601u_suspend(struct usb_interface *usb_intf, pm_message_t state)
344{
345 struct mt7601u_dev *dev = usb_get_intfdata(usb_intf);
346
347 mt7601u_cleanup(dev);
348
349 return 0;
350}
351
352static int mt7601u_resume(struct usb_interface *usb_intf)
353{
354 struct mt7601u_dev *dev = usb_get_intfdata(usb_intf);
355 int ret;
356
357 ret = mt7601u_init_hardware(dev);
358 if (ret)
359 return ret;
360
361 set_bit(MT7601U_STATE_INITIALIZED, &dev->state);
362
363 return 0;
364}
365
366MODULE_DEVICE_TABLE(usb, mt7601u_device_table);
367MODULE_FIRMWARE(MT7601U_FIRMWARE);
368MODULE_DESCRIPTION("MediaTek MT7601U USB Wireless LAN driver");
369MODULE_LICENSE("GPL");
370
371static struct usb_driver mt7601u_driver = {
372 .name = KBUILD_MODNAME,
373 .id_table = mt7601u_device_table,
374 .probe = mt7601u_probe,
375 .disconnect = mt7601u_disconnect,
376 .suspend = mt7601u_suspend,
377 .resume = mt7601u_resume,
378 .reset_resume = mt7601u_resume,
379 .soft_unbind = 1,
380 .disable_hub_initiated_lpm = 1,
381};
382module_usb_driver(mt7601u_driver);
1/*
2 * Copyright (C) 2015 Jakub Kicinski <kubakici@wp.pl>
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2
6 * as published by the Free Software Foundation
7 *
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
12 */
13
14#include <linux/kernel.h>
15#include <linux/module.h>
16#include <linux/usb.h>
17
18#include "mt7601u.h"
19#include "usb.h"
20#include "trace.h"
21
22static struct usb_device_id mt7601u_device_table[] = {
23 { USB_DEVICE(0x0b05, 0x17d3) },
24 { USB_DEVICE(0x0e8d, 0x760a) },
25 { USB_DEVICE(0x0e8d, 0x760b) },
26 { USB_DEVICE(0x13d3, 0x3431) },
27 { USB_DEVICE(0x13d3, 0x3434) },
28 { USB_DEVICE(0x148f, 0x7601) },
29 { USB_DEVICE(0x148f, 0x760a) },
30 { USB_DEVICE(0x148f, 0x760b) },
31 { USB_DEVICE(0x148f, 0x760c) },
32 { USB_DEVICE(0x148f, 0x760d) },
33 { USB_DEVICE(0x2001, 0x3d04) },
34 { USB_DEVICE(0x2717, 0x4106) },
35 { USB_DEVICE(0x2955, 0x0001) },
36 { USB_DEVICE(0x2955, 0x1001) },
37 { USB_DEVICE(0x2a5f, 0x1000) },
38 { USB_DEVICE(0x7392, 0x7710) },
39 { 0, }
40};
41
42bool mt7601u_usb_alloc_buf(struct mt7601u_dev *dev, size_t len,
43 struct mt7601u_dma_buf *buf)
44{
45 struct usb_device *usb_dev = mt7601u_to_usb_dev(dev);
46
47 buf->len = len;
48 buf->urb = usb_alloc_urb(0, GFP_KERNEL);
49 buf->buf = usb_alloc_coherent(usb_dev, buf->len, GFP_KERNEL, &buf->dma);
50
51 return !buf->urb || !buf->buf;
52}
53
54void mt7601u_usb_free_buf(struct mt7601u_dev *dev, struct mt7601u_dma_buf *buf)
55{
56 struct usb_device *usb_dev = mt7601u_to_usb_dev(dev);
57
58 usb_free_coherent(usb_dev, buf->len, buf->buf, buf->dma);
59 usb_free_urb(buf->urb);
60}
61
62int mt7601u_usb_submit_buf(struct mt7601u_dev *dev, int dir, int ep_idx,
63 struct mt7601u_dma_buf *buf, gfp_t gfp,
64 usb_complete_t complete_fn, void *context)
65{
66 struct usb_device *usb_dev = mt7601u_to_usb_dev(dev);
67 unsigned pipe;
68 int ret;
69
70 if (dir == USB_DIR_IN)
71 pipe = usb_rcvbulkpipe(usb_dev, dev->in_eps[ep_idx]);
72 else
73 pipe = usb_sndbulkpipe(usb_dev, dev->out_eps[ep_idx]);
74
75 usb_fill_bulk_urb(buf->urb, usb_dev, pipe, buf->buf, buf->len,
76 complete_fn, context);
77 buf->urb->transfer_dma = buf->dma;
78 buf->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
79
80 trace_mt_submit_urb(dev, buf->urb);
81 ret = usb_submit_urb(buf->urb, gfp);
82 if (ret)
83 dev_err(dev->dev, "Error: submit URB dir:%d ep:%d failed:%d\n",
84 dir, ep_idx, ret);
85 return ret;
86}
87
88void mt7601u_complete_urb(struct urb *urb)
89{
90 struct completion *cmpl = urb->context;
91
92 complete(cmpl);
93}
94
95int mt7601u_vendor_request(struct mt7601u_dev *dev, const u8 req,
96 const u8 direction, const u16 val, const u16 offset,
97 void *buf, const size_t buflen)
98{
99 int i, ret;
100 struct usb_device *usb_dev = mt7601u_to_usb_dev(dev);
101 const u8 req_type = direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE;
102 const unsigned int pipe = (direction == USB_DIR_IN) ?
103 usb_rcvctrlpipe(usb_dev, 0) : usb_sndctrlpipe(usb_dev, 0);
104
105 for (i = 0; i < MT_VEND_REQ_MAX_RETRY; i++) {
106 ret = usb_control_msg(usb_dev, pipe, req, req_type,
107 val, offset, buf, buflen,
108 MT_VEND_REQ_TOUT_MS);
109 trace_mt_vend_req(dev, pipe, req, req_type, val, offset,
110 buf, buflen, ret);
111
112 if (ret == -ENODEV)
113 set_bit(MT7601U_STATE_REMOVED, &dev->state);
114 if (ret >= 0 || ret == -ENODEV)
115 return ret;
116
117 msleep(5);
118 }
119
120 dev_err(dev->dev, "Vendor request req:%02x off:%04x failed:%d\n",
121 req, offset, ret);
122
123 return ret;
124}
125
126void mt7601u_vendor_reset(struct mt7601u_dev *dev)
127{
128 mt7601u_vendor_request(dev, MT_VEND_DEV_MODE, USB_DIR_OUT,
129 MT_VEND_DEV_MODE_RESET, 0, NULL, 0);
130}
131
132u32 mt7601u_rr(struct mt7601u_dev *dev, u32 offset)
133{
134 int ret;
135 u32 val = ~0;
136
137 WARN_ONCE(offset > USHRT_MAX, "read high off:%08x", offset);
138
139 mutex_lock(&dev->vendor_req_mutex);
140
141 ret = mt7601u_vendor_request(dev, MT_VEND_MULTI_READ, USB_DIR_IN,
142 0, offset, dev->vend_buf, MT_VEND_BUF);
143 if (ret == MT_VEND_BUF)
144 val = get_unaligned_le32(dev->vend_buf);
145 else if (ret > 0)
146 dev_err(dev->dev, "Error: wrong size read:%d off:%08x\n",
147 ret, offset);
148
149 mutex_unlock(&dev->vendor_req_mutex);
150
151 trace_reg_read(dev, offset, val);
152 return val;
153}
154
155int mt7601u_vendor_single_wr(struct mt7601u_dev *dev, const u8 req,
156 const u16 offset, const u32 val)
157{
158 int ret;
159
160 mutex_lock(&dev->vendor_req_mutex);
161
162 ret = mt7601u_vendor_request(dev, req, USB_DIR_OUT,
163 val & 0xffff, offset, NULL, 0);
164 if (!ret)
165 ret = mt7601u_vendor_request(dev, req, USB_DIR_OUT,
166 val >> 16, offset + 2, NULL, 0);
167
168 mutex_unlock(&dev->vendor_req_mutex);
169
170 return ret;
171}
172
173void mt7601u_wr(struct mt7601u_dev *dev, u32 offset, u32 val)
174{
175 WARN_ONCE(offset > USHRT_MAX, "write high off:%08x", offset);
176
177 mt7601u_vendor_single_wr(dev, MT_VEND_WRITE, offset, val);
178 trace_reg_write(dev, offset, val);
179}
180
181u32 mt7601u_rmw(struct mt7601u_dev *dev, u32 offset, u32 mask, u32 val)
182{
183 val |= mt7601u_rr(dev, offset) & ~mask;
184 mt7601u_wr(dev, offset, val);
185 return val;
186}
187
188u32 mt7601u_rmc(struct mt7601u_dev *dev, u32 offset, u32 mask, u32 val)
189{
190 u32 reg = mt7601u_rr(dev, offset);
191
192 val |= reg & ~mask;
193 if (reg != val)
194 mt7601u_wr(dev, offset, val);
195 return val;
196}
197
198void mt7601u_wr_copy(struct mt7601u_dev *dev, u32 offset,
199 const void *data, int len)
200{
201 WARN_ONCE(offset & 3, "unaligned write copy off:%08x", offset);
202 WARN_ONCE(len & 3, "short write copy off:%08x", offset);
203
204 mt7601u_burst_write_regs(dev, offset, data, len / 4);
205}
206
207void mt7601u_addr_wr(struct mt7601u_dev *dev, const u32 offset, const u8 *addr)
208{
209 mt7601u_wr(dev, offset, get_unaligned_le32(addr));
210 mt7601u_wr(dev, offset + 4, addr[4] | addr[5] << 8);
211}
212
213static int mt7601u_assign_pipes(struct usb_interface *usb_intf,
214 struct mt7601u_dev *dev)
215{
216 struct usb_endpoint_descriptor *ep_desc;
217 struct usb_host_interface *intf_desc = usb_intf->cur_altsetting;
218 unsigned i, ep_i = 0, ep_o = 0;
219
220 BUILD_BUG_ON(sizeof(dev->in_eps) < __MT_EP_IN_MAX);
221 BUILD_BUG_ON(sizeof(dev->out_eps) < __MT_EP_OUT_MAX);
222
223 for (i = 0; i < intf_desc->desc.bNumEndpoints; i++) {
224 ep_desc = &intf_desc->endpoint[i].desc;
225
226 if (usb_endpoint_is_bulk_in(ep_desc) &&
227 ep_i++ < __MT_EP_IN_MAX) {
228 dev->in_eps[ep_i - 1] = usb_endpoint_num(ep_desc);
229 dev->in_max_packet = usb_endpoint_maxp(ep_desc);
230 /* Note: this is ignored by usb sub-system but vendor
231 * code does it. We can drop this at some point.
232 */
233 dev->in_eps[ep_i - 1] |= USB_DIR_IN;
234 } else if (usb_endpoint_is_bulk_out(ep_desc) &&
235 ep_o++ < __MT_EP_OUT_MAX) {
236 dev->out_eps[ep_o - 1] = usb_endpoint_num(ep_desc);
237 dev->out_max_packet = usb_endpoint_maxp(ep_desc);
238 }
239 }
240
241 if (ep_i != __MT_EP_IN_MAX || ep_o != __MT_EP_OUT_MAX) {
242 dev_err(dev->dev, "Error: wrong pipe number in:%d out:%d\n",
243 ep_i, ep_o);
244 return -EINVAL;
245 }
246
247 return 0;
248}
249
250static int mt7601u_probe(struct usb_interface *usb_intf,
251 const struct usb_device_id *id)
252{
253 struct usb_device *usb_dev = interface_to_usbdev(usb_intf);
254 struct mt7601u_dev *dev;
255 u32 asic_rev, mac_rev;
256 int ret;
257
258 dev = mt7601u_alloc_device(&usb_intf->dev);
259 if (!dev)
260 return -ENOMEM;
261
262 usb_dev = usb_get_dev(usb_dev);
263 usb_reset_device(usb_dev);
264
265 usb_set_intfdata(usb_intf, dev);
266
267 dev->vend_buf = devm_kmalloc(dev->dev, MT_VEND_BUF, GFP_KERNEL);
268 if (!dev->vend_buf) {
269 ret = -ENOMEM;
270 goto err;
271 }
272
273 ret = mt7601u_assign_pipes(usb_intf, dev);
274 if (ret)
275 goto err;
276 ret = mt7601u_wait_asic_ready(dev);
277 if (ret)
278 goto err;
279
280 asic_rev = mt7601u_rr(dev, MT_ASIC_VERSION);
281 mac_rev = mt7601u_rr(dev, MT_MAC_CSR0);
282 dev_info(dev->dev, "ASIC revision: %08x MAC revision: %08x\n",
283 asic_rev, mac_rev);
284
285 /* Note: vendor driver skips this check for MT7601U */
286 if (!(mt7601u_rr(dev, MT_EFUSE_CTRL) & MT_EFUSE_CTRL_SEL))
287 dev_warn(dev->dev, "Warning: eFUSE not present\n");
288
289 ret = mt7601u_init_hardware(dev);
290 if (ret)
291 goto err;
292 ret = mt7601u_register_device(dev);
293 if (ret)
294 goto err_hw;
295
296 set_bit(MT7601U_STATE_INITIALIZED, &dev->state);
297
298 return 0;
299err_hw:
300 mt7601u_cleanup(dev);
301err:
302 usb_set_intfdata(usb_intf, NULL);
303 usb_put_dev(interface_to_usbdev(usb_intf));
304
305 destroy_workqueue(dev->stat_wq);
306 ieee80211_free_hw(dev->hw);
307 return ret;
308}
309
310static void mt7601u_disconnect(struct usb_interface *usb_intf)
311{
312 struct mt7601u_dev *dev = usb_get_intfdata(usb_intf);
313
314 ieee80211_unregister_hw(dev->hw);
315 mt7601u_cleanup(dev);
316
317 usb_set_intfdata(usb_intf, NULL);
318 usb_put_dev(interface_to_usbdev(usb_intf));
319
320 destroy_workqueue(dev->stat_wq);
321 ieee80211_free_hw(dev->hw);
322}
323
324static int mt7601u_suspend(struct usb_interface *usb_intf, pm_message_t state)
325{
326 struct mt7601u_dev *dev = usb_get_intfdata(usb_intf);
327
328 mt7601u_cleanup(dev);
329
330 return 0;
331}
332
333static int mt7601u_resume(struct usb_interface *usb_intf)
334{
335 struct mt7601u_dev *dev = usb_get_intfdata(usb_intf);
336 int ret;
337
338 ret = mt7601u_init_hardware(dev);
339 if (ret)
340 return ret;
341
342 set_bit(MT7601U_STATE_INITIALIZED, &dev->state);
343
344 return 0;
345}
346
347MODULE_DEVICE_TABLE(usb, mt7601u_device_table);
348MODULE_FIRMWARE(MT7601U_FIRMWARE);
349MODULE_LICENSE("GPL");
350
351static struct usb_driver mt7601u_driver = {
352 .name = KBUILD_MODNAME,
353 .id_table = mt7601u_device_table,
354 .probe = mt7601u_probe,
355 .disconnect = mt7601u_disconnect,
356 .suspend = mt7601u_suspend,
357 .resume = mt7601u_resume,
358 .reset_resume = mt7601u_resume,
359 .soft_unbind = 1,
360 .disable_hub_initiated_lpm = 1,
361};
362module_usb_driver(mt7601u_driver);