2 * Copyright (C) 2015 Jakub Kicinski <kubakici@wp.pl>
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
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.
14 #include <linux/kernel.h>
15 #include <linux/module.h>
16 #include <linux/usb.h>
22 static const 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(0x2955, 0x1003) },
38 { USB_DEVICE(0x2a5f, 0x1000) },
39 { USB_DEVICE(0x7392, 0x7710) },
43 bool mt7601u_usb_alloc_buf(struct mt7601u_dev *dev, size_t len,
44 struct mt7601u_dma_buf *buf)
46 struct usb_device *usb_dev = mt7601u_to_usb_dev(dev);
49 buf->urb = usb_alloc_urb(0, GFP_KERNEL);
50 buf->buf = usb_alloc_coherent(usb_dev, buf->len, GFP_KERNEL, &buf->dma);
52 return !buf->urb || !buf->buf;
55 void mt7601u_usb_free_buf(struct mt7601u_dev *dev, struct mt7601u_dma_buf *buf)
57 struct usb_device *usb_dev = mt7601u_to_usb_dev(dev);
59 usb_free_coherent(usb_dev, buf->len, buf->buf, buf->dma);
60 usb_free_urb(buf->urb);
63 int mt7601u_usb_submit_buf(struct mt7601u_dev *dev, int dir, int ep_idx,
64 struct mt7601u_dma_buf *buf, gfp_t gfp,
65 usb_complete_t complete_fn, void *context)
67 struct usb_device *usb_dev = mt7601u_to_usb_dev(dev);
71 if (dir == USB_DIR_IN)
72 pipe = usb_rcvbulkpipe(usb_dev, dev->in_eps[ep_idx]);
74 pipe = usb_sndbulkpipe(usb_dev, dev->out_eps[ep_idx]);
76 usb_fill_bulk_urb(buf->urb, usb_dev, pipe, buf->buf, buf->len,
77 complete_fn, context);
78 buf->urb->transfer_dma = buf->dma;
79 buf->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
81 trace_mt_submit_urb(dev, buf->urb);
82 ret = usb_submit_urb(buf->urb, gfp);
84 dev_err(dev->dev, "Error: submit URB dir:%d ep:%d failed:%d\n",
89 void mt7601u_complete_urb(struct urb *urb)
91 struct completion *cmpl = urb->context;
96 int mt7601u_vendor_request(struct mt7601u_dev *dev, const u8 req,
97 const u8 direction, const u16 val, const u16 offset,
98 void *buf, const size_t buflen)
101 struct usb_device *usb_dev = mt7601u_to_usb_dev(dev);
102 const u8 req_type = direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE;
103 const unsigned int pipe = (direction == USB_DIR_IN) ?
104 usb_rcvctrlpipe(usb_dev, 0) : usb_sndctrlpipe(usb_dev, 0);
106 for (i = 0; i < MT_VEND_REQ_MAX_RETRY; i++) {
107 ret = usb_control_msg(usb_dev, pipe, req, req_type,
108 val, offset, buf, buflen,
109 MT_VEND_REQ_TOUT_MS);
110 trace_mt_vend_req(dev, pipe, req, req_type, val, offset,
114 set_bit(MT7601U_STATE_REMOVED, &dev->state);
115 if (ret >= 0 || ret == -ENODEV)
121 dev_err(dev->dev, "Vendor request req:%02x off:%04x failed:%d\n",
127 void mt7601u_vendor_reset(struct mt7601u_dev *dev)
129 mt7601u_vendor_request(dev, MT_VEND_DEV_MODE, USB_DIR_OUT,
130 MT_VEND_DEV_MODE_RESET, 0, NULL, 0);
133 /* should be called with vendor_req_mutex held */
134 static u32 __mt7601u_rr(struct mt7601u_dev *dev, u32 offset)
139 WARN_ONCE(offset > USHRT_MAX, "read high off:%08x", offset);
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);
146 dev_err(dev->dev, "Error: wrong size read:%d off:%08x\n",
149 trace_reg_read(dev, offset, val);
153 u32 mt7601u_rr(struct mt7601u_dev *dev, u32 offset)
157 mutex_lock(&dev->vendor_req_mutex);
158 ret = __mt7601u_rr(dev, offset);
159 mutex_unlock(&dev->vendor_req_mutex);
164 /* should be called with vendor_req_mutex held */
165 static int __mt7601u_vendor_single_wr(struct mt7601u_dev *dev, const u8 req,
166 const u16 offset, const u32 val)
168 int ret = mt7601u_vendor_request(dev, req, USB_DIR_OUT,
169 val & 0xffff, offset, NULL, 0);
171 ret = mt7601u_vendor_request(dev, req, USB_DIR_OUT,
172 val >> 16, offset + 2, NULL, 0);
173 trace_reg_write(dev, offset, val);
177 int mt7601u_vendor_single_wr(struct mt7601u_dev *dev, const u8 req,
178 const u16 offset, const u32 val)
182 mutex_lock(&dev->vendor_req_mutex);
183 ret = __mt7601u_vendor_single_wr(dev, req, offset, val);
184 mutex_unlock(&dev->vendor_req_mutex);
189 void mt7601u_wr(struct mt7601u_dev *dev, u32 offset, u32 val)
191 WARN_ONCE(offset > USHRT_MAX, "write high off:%08x", offset);
193 mt7601u_vendor_single_wr(dev, MT_VEND_WRITE, offset, val);
196 u32 mt7601u_rmw(struct mt7601u_dev *dev, u32 offset, u32 mask, u32 val)
198 mutex_lock(&dev->vendor_req_mutex);
199 val |= __mt7601u_rr(dev, offset) & ~mask;
200 __mt7601u_vendor_single_wr(dev, MT_VEND_WRITE, offset, val);
201 mutex_unlock(&dev->vendor_req_mutex);
206 u32 mt7601u_rmc(struct mt7601u_dev *dev, u32 offset, u32 mask, u32 val)
210 mutex_lock(&dev->vendor_req_mutex);
211 reg = __mt7601u_rr(dev, offset);
214 __mt7601u_vendor_single_wr(dev, MT_VEND_WRITE,
216 mutex_unlock(&dev->vendor_req_mutex);
221 void mt7601u_wr_copy(struct mt7601u_dev *dev, u32 offset,
222 const void *data, int len)
224 WARN_ONCE(offset & 3, "unaligned write copy off:%08x", offset);
225 WARN_ONCE(len & 3, "short write copy off:%08x", offset);
227 mt7601u_burst_write_regs(dev, offset, data, len / 4);
230 void mt7601u_addr_wr(struct mt7601u_dev *dev, const u32 offset, const u8 *addr)
232 mt7601u_wr(dev, offset, get_unaligned_le32(addr));
233 mt7601u_wr(dev, offset + 4, addr[4] | addr[5] << 8);
236 static int mt7601u_assign_pipes(struct usb_interface *usb_intf,
237 struct mt7601u_dev *dev)
239 struct usb_endpoint_descriptor *ep_desc;
240 struct usb_host_interface *intf_desc = usb_intf->cur_altsetting;
241 unsigned i, ep_i = 0, ep_o = 0;
243 BUILD_BUG_ON(sizeof(dev->in_eps) < __MT_EP_IN_MAX);
244 BUILD_BUG_ON(sizeof(dev->out_eps) < __MT_EP_OUT_MAX);
246 for (i = 0; i < intf_desc->desc.bNumEndpoints; i++) {
247 ep_desc = &intf_desc->endpoint[i].desc;
249 if (usb_endpoint_is_bulk_in(ep_desc) &&
250 ep_i++ < __MT_EP_IN_MAX) {
251 dev->in_eps[ep_i - 1] = usb_endpoint_num(ep_desc);
252 dev->in_max_packet = usb_endpoint_maxp(ep_desc);
253 /* Note: this is ignored by usb sub-system but vendor
254 * code does it. We can drop this at some point.
256 dev->in_eps[ep_i - 1] |= USB_DIR_IN;
257 } else if (usb_endpoint_is_bulk_out(ep_desc) &&
258 ep_o++ < __MT_EP_OUT_MAX) {
259 dev->out_eps[ep_o - 1] = usb_endpoint_num(ep_desc);
260 dev->out_max_packet = usb_endpoint_maxp(ep_desc);
264 if (ep_i != __MT_EP_IN_MAX || ep_o != __MT_EP_OUT_MAX) {
265 dev_err(dev->dev, "Error: wrong pipe number in:%d out:%d\n",
273 static int mt7601u_probe(struct usb_interface *usb_intf,
274 const struct usb_device_id *id)
276 struct usb_device *usb_dev = interface_to_usbdev(usb_intf);
277 struct mt7601u_dev *dev;
278 u32 asic_rev, mac_rev;
281 dev = mt7601u_alloc_device(&usb_intf->dev);
285 usb_dev = usb_get_dev(usb_dev);
286 usb_reset_device(usb_dev);
288 usb_set_intfdata(usb_intf, dev);
290 dev->vend_buf = devm_kmalloc(dev->dev, MT_VEND_BUF, GFP_KERNEL);
291 if (!dev->vend_buf) {
296 ret = mt7601u_assign_pipes(usb_intf, dev);
299 ret = mt7601u_wait_asic_ready(dev);
303 asic_rev = mt7601u_rr(dev, MT_ASIC_VERSION);
304 mac_rev = mt7601u_rr(dev, MT_MAC_CSR0);
305 dev_info(dev->dev, "ASIC revision: %08x MAC revision: %08x\n",
308 /* Note: vendor driver skips this check for MT7601U */
309 if (!(mt7601u_rr(dev, MT_EFUSE_CTRL) & MT_EFUSE_CTRL_SEL))
310 dev_warn(dev->dev, "Warning: eFUSE not present\n");
312 ret = mt7601u_init_hardware(dev);
315 ret = mt7601u_register_device(dev);
319 set_bit(MT7601U_STATE_INITIALIZED, &dev->state);
323 mt7601u_cleanup(dev);
325 usb_set_intfdata(usb_intf, NULL);
326 usb_put_dev(interface_to_usbdev(usb_intf));
328 destroy_workqueue(dev->stat_wq);
329 ieee80211_free_hw(dev->hw);
333 static void mt7601u_disconnect(struct usb_interface *usb_intf)
335 struct mt7601u_dev *dev = usb_get_intfdata(usb_intf);
337 ieee80211_unregister_hw(dev->hw);
338 mt7601u_cleanup(dev);
340 usb_set_intfdata(usb_intf, NULL);
341 usb_put_dev(interface_to_usbdev(usb_intf));
343 destroy_workqueue(dev->stat_wq);
344 ieee80211_free_hw(dev->hw);
347 static int mt7601u_suspend(struct usb_interface *usb_intf, pm_message_t state)
349 struct mt7601u_dev *dev = usb_get_intfdata(usb_intf);
351 mt7601u_cleanup(dev);
356 static int mt7601u_resume(struct usb_interface *usb_intf)
358 struct mt7601u_dev *dev = usb_get_intfdata(usb_intf);
361 ret = mt7601u_init_hardware(dev);
365 set_bit(MT7601U_STATE_INITIALIZED, &dev->state);
370 MODULE_DEVICE_TABLE(usb, mt7601u_device_table);
372 MODULE_LICENSE("GPL");
374 static struct usb_driver mt7601u_driver = {
375 .name = KBUILD_MODNAME,
376 .id_table = mt7601u_device_table,
377 .probe = mt7601u_probe,
378 .disconnect = mt7601u_disconnect,
379 .suspend = mt7601u_suspend,
380 .resume = mt7601u_resume,
381 .reset_resume = mt7601u_resume,
383 .disable_hub_initiated_lpm = 1,
385 module_usb_driver(mt7601u_driver);