Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 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 | |
| 22 | static 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 | |
| 42 | bool 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 | |
| 54 | void 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 | |
| 62 | int 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 | |
| 88 | void mt7601u_complete_urb(struct urb *urb) |
| 89 | { |
| 90 | struct completion *cmpl = urb->context; |
| 91 | |
| 92 | complete(cmpl); |
| 93 | } |
| 94 | |
Jakub Kicinski | bed429e | 2015-07-31 15:04:46 +0200 | [diff] [blame] | 95 | int 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) |
Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 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 | |
Jakub Kicinski | bed429e | 2015-07-31 15:04:46 +0200 | [diff] [blame] | 112 | if (ret == -ENODEV) |
| 113 | set_bit(MT7601U_STATE_REMOVED, &dev->state); |
Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 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 | |
Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 126 | void 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 | |
| 132 | u32 mt7601u_rr(struct mt7601u_dev *dev, u32 offset) |
| 133 | { |
| 134 | int ret; |
Jakub Kicinski | bed429e | 2015-07-31 15:04:46 +0200 | [diff] [blame] | 135 | u32 val = ~0; |
Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 136 | |
| 137 | WARN_ONCE(offset > USHRT_MAX, "read high off:%08x", offset); |
| 138 | |
Jakub Kicinski | bed429e | 2015-07-31 15:04:46 +0200 | [diff] [blame] | 139 | mutex_lock(&dev->vendor_req_mutex); |
| 140 | |
Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 141 | ret = mt7601u_vendor_request(dev, MT_VEND_MULTI_READ, USB_DIR_IN, |
Jakub Kicinski | bed429e | 2015-07-31 15:04:46 +0200 | [diff] [blame] | 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) |
Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 146 | dev_err(dev->dev, "Error: wrong size read:%d off:%08x\n", |
| 147 | ret, offset); |
Jakub Kicinski | bed429e | 2015-07-31 15:04:46 +0200 | [diff] [blame] | 148 | |
| 149 | mutex_unlock(&dev->vendor_req_mutex); |
Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 150 | |
| 151 | trace_reg_read(dev, offset, val); |
| 152 | return val; |
| 153 | } |
| 154 | |
| 155 | int mt7601u_vendor_single_wr(struct mt7601u_dev *dev, const u8 req, |
| 156 | const u16 offset, const u32 val) |
| 157 | { |
| 158 | int ret; |
| 159 | |
Jakub Kicinski | bed429e | 2015-07-31 15:04:46 +0200 | [diff] [blame] | 160 | mutex_lock(&dev->vendor_req_mutex); |
| 161 | |
Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 162 | ret = mt7601u_vendor_request(dev, req, USB_DIR_OUT, |
| 163 | val & 0xffff, offset, NULL, 0); |
Jakub Kicinski | bed429e | 2015-07-31 15:04:46 +0200 | [diff] [blame] | 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; |
Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 171 | } |
| 172 | |
| 173 | void 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 | |
| 181 | u32 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 | |
| 188 | u32 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 | |
| 198 | void 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 | |
| 207 | void 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 | |
| 213 | static 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 | |
| 250 | static 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 | |
Jakub Kicinski | bed429e | 2015-07-31 15:04:46 +0200 | [diff] [blame] | 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 | |
Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 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; |
| 299 | err_hw: |
| 300 | mt7601u_cleanup(dev); |
| 301 | err: |
| 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 | |
| 310 | static 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 | |
| 324 | static 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 | |
| 333 | static int mt7601u_resume(struct usb_interface *usb_intf) |
| 334 | { |
| 335 | struct mt7601u_dev *dev = usb_get_intfdata(usb_intf); |
Jakub Kicinski | 9a15b57 | 2015-06-02 21:11:27 +0200 | [diff] [blame] | 336 | int ret; |
Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 337 | |
Jakub Kicinski | 9a15b57 | 2015-06-02 21:11:27 +0200 | [diff] [blame] | 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; |
Jakub Kicinski | c869f77 | 2015-05-26 11:16:00 +0200 | [diff] [blame] | 345 | } |
| 346 | |
| 347 | MODULE_DEVICE_TABLE(usb, mt7601u_device_table); |
| 348 | MODULE_FIRMWARE(MT7601U_FIRMWARE); |
| 349 | MODULE_LICENSE("GPL"); |
| 350 | |
| 351 | static 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 | }; |
| 362 | module_usb_driver(mt7601u_driver); |