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