Message ID | 1530771142-4118-5-git-send-email-sgruszka@redhat.com (mailing list archive) |
---|---|
State | Changes Requested |
Delegated to: | Kalle Valo |
Headers | show |
On Jul 05, Stanislaw Gruszka wrote: > Add usb files of mt76x0 driver. > > Signed-off-by: Stanislaw Gruszka <sgruszka@redhat.com> > --- > drivers/net/wireless/mediatek/mt76/mt76x0/usb.c | 377 ++++++++++++++++++++++++ > drivers/net/wireless/mediatek/mt76/mt76x0/usb.h | 61 ++++ > 2 files changed, 438 insertions(+) > create mode 100644 drivers/net/wireless/mediatek/mt76/mt76x0/usb.c > create mode 100644 drivers/net/wireless/mediatek/mt76/mt76x0/usb.h > > diff --git a/drivers/net/wireless/mediatek/mt76/mt76x0/usb.c b/drivers/net/wireless/mediatek/mt76/mt76x0/usb.c > new file mode 100644 > index 000000000000..0871fdef59c3 > --- /dev/null > +++ b/drivers/net/wireless/mediatek/mt76/mt76x0/usb.c > @@ -0,0 +1,377 @@ > +/* > + * Copyright (C) 2015 Jakub Kicinski <kubakici@wp.pl> > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License version 2 > + * as published by the Free Software Foundation > + * > + * This program is distributed in the hope that it will be useful, > + * but WITHOUT ANY WARRANTY; without even the implied warranty of > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the > + * GNU General Public License for more details. > + */ > + > +#include <linux/kernel.h> > +#include <linux/module.h> > +#include <linux/usb.h> > + > +#include "mt76x0.h" > +#include "usb.h" > +#include "trace.h" > + > +static struct usb_device_id mt76x0_device_table[] = { > + { USB_DEVICE(0x148F, 0x7610) }, /* MT7610U */ > + { USB_DEVICE(0x13B1, 0x003E) }, /* Linksys AE6000 */ > + { USB_DEVICE(0x0E8D, 0x7610) }, /* Sabrent NTWLAC */ > + { USB_DEVICE(0x7392, 0xa711) }, /* Edimax 7711mac */ > + { USB_DEVICE(0x7392, 0xb711) }, /* Edimax / Elecom */ > + { USB_DEVICE(0x148f, 0x761a) }, /* TP-Link TL-WDN5200 */ > + { USB_DEVICE(0x148f, 0x760a) }, /* TP-Link unknown */ > + { USB_DEVICE(0x0b05, 0x17d1) }, /* Asus USB-AC51 */ > + { USB_DEVICE(0x0b05, 0x17db) }, /* Asus USB-AC50 */ > + { USB_DEVICE(0x0df6, 0x0075) }, /* Sitecom WLA-3100 */ > + { USB_DEVICE(0x2019, 0xab31) }, /* Planex GW-450D */ > + { USB_DEVICE(0x2001, 0x3d02) }, /* D-LINK DWA-171 rev B1 */ > + { USB_DEVICE(0x0586, 0x3425) }, /* Zyxel NWD6505 */ > + { USB_DEVICE(0x07b8, 0x7610) }, /* AboCom AU7212 */ > + { USB_DEVICE(0x04bb, 0x0951) }, /* I-O DATA WN-AC433UK */ > + { USB_DEVICE(0x057c, 0x8502) }, /* AVM FRITZ!WLAN USB Stick AC 430 */ > + { USB_DEVICE(0x293c, 0x5702) }, /* Comcast Xfinity KXW02AAA */ > + { USB_DEVICE(0x20f4, 0x806b) }, /* TRENDnet TEW-806UBH */ > + { USB_DEVICE(0x7392, 0xc711) }, /* Devolo Wifi ac Stick */ > + { USB_DEVICE(0x0df6, 0x0079) }, /* Sitecom Europe B.V. ac Stick */ > + { USB_DEVICE(0x2357, 0x0105) }, /* TP-LINK Archer T1U */ > + { USB_DEVICE_AND_INTERFACE_INFO(0x0E8D, 0x7630, 0xff, 0x2, 0xff)}, /* MT7630U */ > + { USB_DEVICE_AND_INTERFACE_INFO(0x0E8D, 0x7650, 0xff, 0x2, 0xff)}, /* MT7650U */ > + { 0, } > +}; > + > +bool mt76x0_usb_alloc_buf(struct mt76x0_dev *dev, size_t len, > + struct mt76x0_dma_buf *buf) > +{ > + struct usb_device *usb_dev = mt76x0_to_usb_dev(dev); > + > + buf->len = len; > + buf->urb = usb_alloc_urb(0, GFP_KERNEL); > + buf->buf = usb_alloc_coherent(usb_dev, buf->len, GFP_KERNEL, &buf->dma); > + > + return !buf->urb || !buf->buf; > +} > + > +void mt76x0_usb_free_buf(struct mt76x0_dev *dev, struct mt76x0_dma_buf *buf) > +{ > + struct usb_device *usb_dev = mt76x0_to_usb_dev(dev); > + > + usb_free_coherent(usb_dev, buf->len, buf->buf, buf->dma); > + usb_free_urb(buf->urb); > +} > + > +int mt76x0_usb_submit_buf(struct mt76x0_dev *dev, int dir, int ep_idx, > + struct mt76x0_dma_buf *buf, gfp_t gfp, > + usb_complete_t complete_fn, void *context) > +{ > + struct usb_device *usb_dev = mt76x0_to_usb_dev(dev); > + unsigned pipe; > + int ret; > + > + if (dir == USB_DIR_IN) > + pipe = usb_rcvbulkpipe(usb_dev, dev->in_ep[ep_idx]); > + else > + pipe = usb_sndbulkpipe(usb_dev, dev->out_ep[ep_idx]); > + > + usb_fill_bulk_urb(buf->urb, usb_dev, pipe, buf->buf, buf->len, > + complete_fn, context); > + buf->urb->transfer_dma = buf->dma; > + buf->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; > + > + trace_mt_submit_urb(&dev->mt76, buf->urb); > + ret = usb_submit_urb(buf->urb, gfp); > + if (ret) > + dev_err(dev->mt76.dev, "Error: submit URB dir:%d ep:%d failed:%d\n", > + dir, ep_idx, ret); > + return ret; > +} > + > +void mt76x0_complete_urb(struct urb *urb) > +{ > + struct completion *cmpl = urb->context; > + > + complete(cmpl); > +} > + > +int mt76x0_vendor_request(struct mt76x0_dev *dev, const u8 req, > + const u8 direction, const u16 val, const u16 offset, > + void *buf, const size_t buflen) > +{ > + int i, ret; > + struct usb_device *usb_dev = mt76x0_to_usb_dev(dev); > + const u8 req_type = direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE; > + const unsigned int pipe = (direction == USB_DIR_IN) ? > + usb_rcvctrlpipe(usb_dev, 0) : usb_sndctrlpipe(usb_dev, 0); > + > + for (i = 0; i < MT_VEND_REQ_MAX_RETRY; i++) { > + ret = usb_control_msg(usb_dev, pipe, req, req_type, > + val, offset, buf, buflen, > + MT_VEND_REQ_TOUT_MS); > + trace_mt_vend_req(&dev->mt76, pipe, req, req_type, val, offset, > + buf, buflen, ret); > + > + if (ret == -ENODEV) > + set_bit(MT76_REMOVED, &dev->mt76.state); > + if (ret >= 0 || ret == -ENODEV) > + return ret; > + > + msleep(5); > + } > + > + dev_err(dev->mt76.dev, "Vendor request req:%02x off:%04x failed:%d\n", > + req, offset, ret); > + > + return ret; > +} > + > +void mt76x0_vendor_reset(struct mt76x0_dev *dev) > +{ > + mt76x0_vendor_request(dev, MT_VEND_DEV_MODE, USB_DIR_OUT, > + MT_VEND_DEV_MODE_RESET, 0, NULL, 0); > +} > + > +static u32 mt76x0_rr(struct mt76_dev *dev, u32 offset) > +{ > + struct mt76x0_dev *mdev = (struct mt76x0_dev *) dev; > + int ret; > + u32 val = ~0; > + > + WARN_ONCE(offset > USHRT_MAX, "read high off:%08x", offset); > + > + mutex_lock(&mdev->usb_ctrl_mtx); > + > + ret = mt76x0_vendor_request((struct mt76x0_dev *)dev, MT_VEND_MULTI_READ, USB_DIR_IN, > + 0, offset, mdev->data, MT_VEND_BUF); > + if (ret == MT_VEND_BUF) > + val = get_unaligned_le32(mdev->data); > + else if (ret > 0) > + dev_err(dev->dev, "Error: wrong size read:%d off:%08x\n", > + ret, offset); > + > + mutex_unlock(&mdev->usb_ctrl_mtx); > + > + trace_reg_read(dev, offset, val); > + return val; > +} > + > +int mt76x0_vendor_single_wr(struct mt76x0_dev *dev, const u8 req, > + const u16 offset, const u32 val) > +{ > + struct mt76x0_dev *mdev = dev; > + int ret; > + > + mutex_lock(&mdev->usb_ctrl_mtx); > + > + ret = mt76x0_vendor_request(dev, req, USB_DIR_OUT, > + val & 0xffff, offset, NULL, 0); > + if (!ret) > + ret = mt76x0_vendor_request(dev, req, USB_DIR_OUT, > + val >> 16, offset + 2, NULL, 0); > + > + mutex_unlock(&mdev->usb_ctrl_mtx); > + > + return ret; > +} > + > +static void mt76x0_wr(struct mt76_dev *dev, u32 offset, u32 val) > +{ > + struct mt76x0_dev *mdev = (struct mt76x0_dev *) dev; > + int ret; > + > + WARN_ONCE(offset > USHRT_MAX, "write high off:%08x", offset); > + > + mutex_lock(&mdev->usb_ctrl_mtx); > + > + put_unaligned_le32(val, mdev->data); > + ret = mt76x0_vendor_request(mdev, MT_VEND_MULTI_WRITE, USB_DIR_OUT, > + 0, offset, mdev->data, MT_VEND_BUF); > + trace_reg_write(dev, offset, val); > + > + mutex_unlock(&mdev->usb_ctrl_mtx); > +} > + > +static u32 mt76x0_rmw(struct mt76_dev *dev, u32 offset, u32 mask, u32 val) > +{ > + val |= mt76x0_rr(dev, offset) & ~mask; > + mt76x0_wr(dev, offset, val); > + return val; > +} > + > +static void mt76x0_wr_copy(struct mt76_dev *dev, u32 offset, > + const void *data, int len) > +{ > + WARN_ONCE(offset & 3, "unaligned write copy off:%08x", offset); > + WARN_ONCE(len & 3, "short write copy off:%08x", offset); > + > + mt76x0_burst_write_regs((struct mt76x0_dev *) dev, offset, data, len / 4); > +} > + > +void mt76x0_addr_wr(struct mt76x0_dev *dev, const u32 offset, const u8 *addr) > +{ > + mt76_wr(dev, offset, get_unaligned_le32(addr)); > + mt76_wr(dev, offset + 4, addr[4] | addr[5] << 8); > +} > + > +static int mt76x0_assign_pipes(struct usb_interface *usb_intf, > + struct mt76x0_dev *dev) > +{ > + struct usb_endpoint_descriptor *ep_desc; > + struct usb_host_interface *intf_desc = usb_intf->cur_altsetting; > + unsigned i, ep_i = 0, ep_o = 0; > + > + BUILD_BUG_ON(sizeof(dev->in_ep) < __MT_EP_IN_MAX); > + BUILD_BUG_ON(sizeof(dev->out_ep) < __MT_EP_OUT_MAX); > + > + for (i = 0; i < intf_desc->desc.bNumEndpoints; i++) { > + ep_desc = &intf_desc->endpoint[i].desc; > + > + if (usb_endpoint_is_bulk_in(ep_desc) && > + ep_i++ < __MT_EP_IN_MAX) { > + dev->in_ep[ep_i - 1] = usb_endpoint_num(ep_desc); > + dev->in_max_packet = usb_endpoint_maxp(ep_desc); > + /* Note: this is ignored by usb sub-system but vendor > + * code does it. We can drop this at some point. > + */ > + dev->in_ep[ep_i - 1] |= USB_DIR_IN; > + } else if (usb_endpoint_is_bulk_out(ep_desc) && > + ep_o++ < __MT_EP_OUT_MAX) { > + dev->out_ep[ep_o - 1] = usb_endpoint_num(ep_desc); > + dev->out_max_packet = usb_endpoint_maxp(ep_desc); > + } > + } > + > + if (ep_i != __MT_EP_IN_MAX || ep_o != __MT_EP_OUT_MAX) { > + dev_err(dev->mt76.dev, "Error: wrong pipe number in:%d out:%d\n", > + ep_i, ep_o); > + return -EINVAL; > + } > + > + return 0; > +} > + > +static int mt76x0_probe(struct usb_interface *usb_intf, > + const struct usb_device_id *id) > +{ > + struct usb_device *usb_dev = interface_to_usbdev(usb_intf); > + struct mt76x0_dev *dev; > + u32 asic_rev, mac_rev; > + int ret; > + static const struct mt76_bus_ops usb_ops = { > + .rr = mt76x0_rr, > + .wr = mt76x0_wr, > + .rmw = mt76x0_rmw, > + .copy = mt76x0_wr_copy, > + }; > + > + dev = mt76x0_alloc_device(&usb_intf->dev); > + if (!dev) > + return -ENOMEM; > + > + usb_dev = usb_get_dev(usb_dev); > + usb_reset_device(usb_dev); > + > + usb_set_intfdata(usb_intf, dev); > + > + dev->mt76.bus = &usb_ops; > + > + ret = mt76x0_assign_pipes(usb_intf, dev); > + if (ret) > + goto err; > + ret = mt76x0_wait_asic_ready(dev); > + if (ret) > + goto err; > + > + asic_rev = mt76_rr(dev, MT_ASIC_VERSION); > + mac_rev = mt76_rr(dev, MT_MAC_CSR0); > + dev_info(dev->mt76.dev, "ASIC revision: %08x MAC revision: %08x\n", > + asic_rev, mac_rev); > + > + /* Note: vendor driver skips this check for MT76X0U */ > + if (!(mt76_rr(dev, MT_EFUSE_CTRL) & MT_EFUSE_CTRL_SEL)) > + dev_warn(dev->mt76.dev, "Warning: eFUSE not present\n"); > + > + ret = mt76x0_init_hardware(dev); > + if (ret) > + goto err; > + > + ret = mt76x0_register_device(dev); > + if (ret) > + goto err_hw; > + > + set_bit(MT76_STATE_INITIALIZED, &dev->mt76.state); > + > + return 0; > +err_hw: > + mt76x0_cleanup(dev); > +err: > + usb_set_intfdata(usb_intf, NULL); > + usb_put_dev(interface_to_usbdev(usb_intf)); > + > + destroy_workqueue(dev->stat_wq); > + ieee80211_free_hw(dev->mt76.hw); > + return ret; > +} > + > +static void mt76x0_disconnect(struct usb_interface *usb_intf) > +{ > + struct mt76x0_dev *dev = usb_get_intfdata(usb_intf); > + bool initalized = test_bit(MT76_STATE_INITIALIZED, &dev->mt76.state); > + > + if (!initalized) > + return; > + > + ieee80211_unregister_hw(dev->mt76.hw); > + mt76x0_cleanup(dev); > + > + usb_set_intfdata(usb_intf, NULL); > + usb_put_dev(interface_to_usbdev(usb_intf)); > + > + destroy_workqueue(dev->stat_wq); > + ieee80211_free_hw(dev->mt76.hw); > +} > + > +static int mt76x0_suspend(struct usb_interface *usb_intf, pm_message_t state) > +{ > + struct mt76x0_dev *dev = usb_get_intfdata(usb_intf); > + > + mt76x0_cleanup(dev); Is it necessary to deallocate rx queue here in case of a system suspend? > + > + return 0; > +} > + > +static int mt76x0_resume(struct usb_interface *usb_intf) > +{ > + struct mt76x0_dev *dev = usb_get_intfdata(usb_intf); > + int ret; > + > + ret = mt76x0_init_hardware(dev); > + if (ret) > + return ret; > + > + set_bit(MT76_STATE_INITIALIZED, &dev->mt76.state); > + > + return 0; > +} > + > +MODULE_DEVICE_TABLE(usb, mt76x0_device_table); > +MODULE_FIRMWARE(MT7610_FIRMWARE); > +MODULE_LICENSE("GPL"); > + > +static struct usb_driver mt76x0_driver = { > + .name = KBUILD_MODNAME, > + .id_table = mt76x0_device_table, > + .probe = mt76x0_probe, > + .disconnect = mt76x0_disconnect, > + .suspend = mt76x0_suspend, > + .resume = mt76x0_resume, > + .reset_resume = mt76x0_resume, > + .soft_unbind = 1, > + .disable_hub_initiated_lpm = 1, > +}; > +module_usb_driver(mt76x0_driver); > diff --git a/drivers/net/wireless/mediatek/mt76/mt76x0/usb.h b/drivers/net/wireless/mediatek/mt76/mt76x0/usb.h > new file mode 100644 > index 000000000000..9e42dfa665de > --- /dev/null > +++ b/drivers/net/wireless/mediatek/mt76/mt76x0/usb.h > @@ -0,0 +1,61 @@ > +/* > + * Copyright (C) 2015 Jakub Kicinski <kubakici@wp.pl> > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License version 2 > + * as published by the Free Software Foundation > + * > + * This program is distributed in the hope that it will be useful, > + * but WITHOUT ANY WARRANTY; without even the implied warranty of > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the > + * GNU General Public License for more details. > + */ > + > +#ifndef __MT76X0U_USB_H > +#define __MT76X0U_USB_H > + > +#include "mt76x0.h" > + > +#define MT7610_FIRMWARE "mt7610.bin" > + > +#define MT_VEND_REQ_MAX_RETRY 10 > +#define MT_VEND_REQ_TOUT_MS 300 > + > +#define MT_VEND_DEV_MODE_RESET 1 > + > +#define MT_VEND_BUF sizeof(__le32) > + > +static inline struct usb_device *mt76x0_to_usb_dev(struct mt76x0_dev *mt76x0) > +{ > + return interface_to_usbdev(to_usb_interface(mt76x0->mt76.dev)); > +} > + > +static inline struct usb_device *mt76_to_usb_dev(struct mt76_dev *mt76) > +{ > + return interface_to_usbdev(to_usb_interface(mt76->dev)); > +} > + > +static inline bool mt76x0_urb_has_error(struct urb *urb) > +{ > + return urb->status && > + urb->status != -ENOENT && > + urb->status != -ECONNRESET && > + urb->status != -ESHUTDOWN; > +} > + > +bool mt76x0_usb_alloc_buf(struct mt76x0_dev *dev, size_t len, > + struct mt76x0_dma_buf *buf); > +void mt76x0_usb_free_buf(struct mt76x0_dev *dev, struct mt76x0_dma_buf *buf); > +int mt76x0_usb_submit_buf(struct mt76x0_dev *dev, int dir, int ep_idx, > + struct mt76x0_dma_buf *buf, gfp_t gfp, > + usb_complete_t complete_fn, void *context); > +void mt76x0_complete_urb(struct urb *urb); > + > +int mt76x0_vendor_request(struct mt76x0_dev *dev, const u8 req, > + const u8 direction, const u16 val, const u16 offset, > + void *buf, const size_t buflen); > +void mt76x0_vendor_reset(struct mt76x0_dev *dev); > +int mt76x0_vendor_single_wr(struct mt76x0_dev *dev, const u8 req, > + const u16 offset, const u32 val); > + > +#endif > -- > 1.9.3 >
On Thu, Jul 05, 2018 at 05:05:20PM +0200, Lorenzo Bianconi wrote: > > +static int mt76x0_suspend(struct usb_interface *usb_intf, pm_message_t state) > > +{ > > + struct mt76x0_dev *dev = usb_get_intfdata(usb_intf); > > + > > + mt76x0_cleanup(dev); > > Is it necessary to deallocate rx queue here in case of a system suspend? > It's not optimal, but allow to utilize initialization and cleanup routines in resume/suspend. Regards. Stanislaw
Lorenzo Bianconi <lorenzo.bianconi@redhat.com> writes: > On Jul 05, Stanislaw Gruszka wrote: >> Add usb files of mt76x0 driver. >> >> Signed-off-by: Stanislaw Gruszka <sgruszka@redhat.com> [...] >> +static int mt76x0_suspend(struct usb_interface *usb_intf, pm_message_t state) >> +{ >> + struct mt76x0_dev *dev = usb_get_intfdata(usb_intf); >> + >> + mt76x0_cleanup(dev); > > Is it necessary to deallocate rx queue here in case of a system suspend? BTW it would really helpful to others if you could edit your quotes. It takes some time to find your oneliner from a 450 line message.
> > Lorenzo Bianconi <lorenzo.bianconi@redhat.com> writes: > > > On Jul 05, Stanislaw Gruszka wrote: > >> Add usb files of mt76x0 driver. > >> > >> Signed-off-by: Stanislaw Gruszka <sgruszka@redhat.com> > > [...] > > >> +static int mt76x0_suspend(struct usb_interface *usb_intf, pm_message_t state) > >> +{ > >> + struct mt76x0_dev *dev = usb_get_intfdata(usb_intf); > >> + > >> + mt76x0_cleanup(dev); > > > > Is it necessary to deallocate rx queue here in case of a system suspend? > > BTW it would really helpful to others if you could edit your quotes. It > takes some time to find your oneliner from a 450 line message. Ack sorry, I will be more verbose next time :). I mean that AFAIU it is not necessary to deallocate all buffers in the rx queue during suspend/resume (using mt76x0_cleanup routine) but we can just mark them as 'free' and reuse them as soon as the hw is resumed. I guess the same approach can be used for mcu rx buffer. Regards, Lorenzo > > -- > Kalle Valo
Lorenzo Bianconi <lorenzo.bianconi@redhat.com> writes: >> >> Lorenzo Bianconi <lorenzo.bianconi@redhat.com> writes: >> >> > On Jul 05, Stanislaw Gruszka wrote: >> >> Add usb files of mt76x0 driver. >> >> >> >> Signed-off-by: Stanislaw Gruszka <sgruszka@redhat.com> >> >> [...] >> >> >> +static int mt76x0_suspend(struct usb_interface *usb_intf, pm_message_t state) >> >> +{ >> >> + struct mt76x0_dev *dev = usb_get_intfdata(usb_intf); >> >> + >> >> + mt76x0_cleanup(dev); >> > >> > Is it necessary to deallocate rx queue here in case of a system suspend? >> >> BTW it would really helpful to others if you could edit your quotes. It >> takes some time to find your oneliner from a 450 line message. > > Ack sorry, I will be more verbose next time :). I think you misunderstood, I actually was asking to be less verbose :) The oneliner was just fine. I was just suggesting that instead of sending a message with 400 lines trim the unnecessary quotation and just send a shorter 50 line message. That way you save a lot of time (and avoid frustration) for the people reading your mail.
> Lorenzo Bianconi <lorenzo.bianconi@redhat.com> writes: > > >> > >> Lorenzo Bianconi <lorenzo.bianconi@redhat.com> writes: > >> > >> > On Jul 05, Stanislaw Gruszka wrote: > >> >> Add usb files of mt76x0 driver. > >> >> > >> >> Signed-off-by: Stanislaw Gruszka <sgruszka@redhat.com> > >> > >> [...] > >> > >> >> +static int mt76x0_suspend(struct usb_interface *usb_intf, pm_message_t state) > >> >> +{ > >> >> + struct mt76x0_dev *dev = usb_get_intfdata(usb_intf); > >> >> + > >> >> + mt76x0_cleanup(dev); > >> > > >> > Is it necessary to deallocate rx queue here in case of a system suspend? > >> > >> BTW it would really helpful to others if you could edit your quotes. It > >> takes some time to find your oneliner from a 450 line message. > > > > Ack sorry, I will be more verbose next time :). > > I think you misunderstood, I actually was asking to be less verbose :) > > The oneliner was just fine. I was just suggesting that instead of > sending a message with 400 lines trim the unnecessary quotation and just > send a shorter 50 line message. That way you save a lot of time (and > avoid frustration) for the people reading your mail. Ops, I completely misunderstood, will do next time sorry :) Regards, Lorenzo > > -- > Kalle Valo
diff --git a/drivers/net/wireless/mediatek/mt76/mt76x0/usb.c b/drivers/net/wireless/mediatek/mt76/mt76x0/usb.c new file mode 100644 index 000000000000..0871fdef59c3 --- /dev/null +++ b/drivers/net/wireless/mediatek/mt76/mt76x0/usb.c @@ -0,0 +1,377 @@ +/* + * Copyright (C) 2015 Jakub Kicinski <kubakici@wp.pl> + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 + * as published by the Free Software Foundation + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + */ + +#include <linux/kernel.h> +#include <linux/module.h> +#include <linux/usb.h> + +#include "mt76x0.h" +#include "usb.h" +#include "trace.h" + +static struct usb_device_id mt76x0_device_table[] = { + { USB_DEVICE(0x148F, 0x7610) }, /* MT7610U */ + { USB_DEVICE(0x13B1, 0x003E) }, /* Linksys AE6000 */ + { USB_DEVICE(0x0E8D, 0x7610) }, /* Sabrent NTWLAC */ + { USB_DEVICE(0x7392, 0xa711) }, /* Edimax 7711mac */ + { USB_DEVICE(0x7392, 0xb711) }, /* Edimax / Elecom */ + { USB_DEVICE(0x148f, 0x761a) }, /* TP-Link TL-WDN5200 */ + { USB_DEVICE(0x148f, 0x760a) }, /* TP-Link unknown */ + { USB_DEVICE(0x0b05, 0x17d1) }, /* Asus USB-AC51 */ + { USB_DEVICE(0x0b05, 0x17db) }, /* Asus USB-AC50 */ + { USB_DEVICE(0x0df6, 0x0075) }, /* Sitecom WLA-3100 */ + { USB_DEVICE(0x2019, 0xab31) }, /* Planex GW-450D */ + { USB_DEVICE(0x2001, 0x3d02) }, /* D-LINK DWA-171 rev B1 */ + { USB_DEVICE(0x0586, 0x3425) }, /* Zyxel NWD6505 */ + { USB_DEVICE(0x07b8, 0x7610) }, /* AboCom AU7212 */ + { USB_DEVICE(0x04bb, 0x0951) }, /* I-O DATA WN-AC433UK */ + { USB_DEVICE(0x057c, 0x8502) }, /* AVM FRITZ!WLAN USB Stick AC 430 */ + { USB_DEVICE(0x293c, 0x5702) }, /* Comcast Xfinity KXW02AAA */ + { USB_DEVICE(0x20f4, 0x806b) }, /* TRENDnet TEW-806UBH */ + { USB_DEVICE(0x7392, 0xc711) }, /* Devolo Wifi ac Stick */ + { USB_DEVICE(0x0df6, 0x0079) }, /* Sitecom Europe B.V. ac Stick */ + { USB_DEVICE(0x2357, 0x0105) }, /* TP-LINK Archer T1U */ + { USB_DEVICE_AND_INTERFACE_INFO(0x0E8D, 0x7630, 0xff, 0x2, 0xff)}, /* MT7630U */ + { USB_DEVICE_AND_INTERFACE_INFO(0x0E8D, 0x7650, 0xff, 0x2, 0xff)}, /* MT7650U */ + { 0, } +}; + +bool mt76x0_usb_alloc_buf(struct mt76x0_dev *dev, size_t len, + struct mt76x0_dma_buf *buf) +{ + struct usb_device *usb_dev = mt76x0_to_usb_dev(dev); + + buf->len = len; + buf->urb = usb_alloc_urb(0, GFP_KERNEL); + buf->buf = usb_alloc_coherent(usb_dev, buf->len, GFP_KERNEL, &buf->dma); + + return !buf->urb || !buf->buf; +} + +void mt76x0_usb_free_buf(struct mt76x0_dev *dev, struct mt76x0_dma_buf *buf) +{ + struct usb_device *usb_dev = mt76x0_to_usb_dev(dev); + + usb_free_coherent(usb_dev, buf->len, buf->buf, buf->dma); + usb_free_urb(buf->urb); +} + +int mt76x0_usb_submit_buf(struct mt76x0_dev *dev, int dir, int ep_idx, + struct mt76x0_dma_buf *buf, gfp_t gfp, + usb_complete_t complete_fn, void *context) +{ + struct usb_device *usb_dev = mt76x0_to_usb_dev(dev); + unsigned pipe; + int ret; + + if (dir == USB_DIR_IN) + pipe = usb_rcvbulkpipe(usb_dev, dev->in_ep[ep_idx]); + else + pipe = usb_sndbulkpipe(usb_dev, dev->out_ep[ep_idx]); + + usb_fill_bulk_urb(buf->urb, usb_dev, pipe, buf->buf, buf->len, + complete_fn, context); + buf->urb->transfer_dma = buf->dma; + buf->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; + + trace_mt_submit_urb(&dev->mt76, buf->urb); + ret = usb_submit_urb(buf->urb, gfp); + if (ret) + dev_err(dev->mt76.dev, "Error: submit URB dir:%d ep:%d failed:%d\n", + dir, ep_idx, ret); + return ret; +} + +void mt76x0_complete_urb(struct urb *urb) +{ + struct completion *cmpl = urb->context; + + complete(cmpl); +} + +int mt76x0_vendor_request(struct mt76x0_dev *dev, const u8 req, + const u8 direction, const u16 val, const u16 offset, + void *buf, const size_t buflen) +{ + int i, ret; + struct usb_device *usb_dev = mt76x0_to_usb_dev(dev); + const u8 req_type = direction | USB_TYPE_VENDOR | USB_RECIP_DEVICE; + const unsigned int pipe = (direction == USB_DIR_IN) ? + usb_rcvctrlpipe(usb_dev, 0) : usb_sndctrlpipe(usb_dev, 0); + + for (i = 0; i < MT_VEND_REQ_MAX_RETRY; i++) { + ret = usb_control_msg(usb_dev, pipe, req, req_type, + val, offset, buf, buflen, + MT_VEND_REQ_TOUT_MS); + trace_mt_vend_req(&dev->mt76, pipe, req, req_type, val, offset, + buf, buflen, ret); + + if (ret == -ENODEV) + set_bit(MT76_REMOVED, &dev->mt76.state); + if (ret >= 0 || ret == -ENODEV) + return ret; + + msleep(5); + } + + dev_err(dev->mt76.dev, "Vendor request req:%02x off:%04x failed:%d\n", + req, offset, ret); + + return ret; +} + +void mt76x0_vendor_reset(struct mt76x0_dev *dev) +{ + mt76x0_vendor_request(dev, MT_VEND_DEV_MODE, USB_DIR_OUT, + MT_VEND_DEV_MODE_RESET, 0, NULL, 0); +} + +static u32 mt76x0_rr(struct mt76_dev *dev, u32 offset) +{ + struct mt76x0_dev *mdev = (struct mt76x0_dev *) dev; + int ret; + u32 val = ~0; + + WARN_ONCE(offset > USHRT_MAX, "read high off:%08x", offset); + + mutex_lock(&mdev->usb_ctrl_mtx); + + ret = mt76x0_vendor_request((struct mt76x0_dev *)dev, MT_VEND_MULTI_READ, USB_DIR_IN, + 0, offset, mdev->data, MT_VEND_BUF); + if (ret == MT_VEND_BUF) + val = get_unaligned_le32(mdev->data); + else if (ret > 0) + dev_err(dev->dev, "Error: wrong size read:%d off:%08x\n", + ret, offset); + + mutex_unlock(&mdev->usb_ctrl_mtx); + + trace_reg_read(dev, offset, val); + return val; +} + +int mt76x0_vendor_single_wr(struct mt76x0_dev *dev, const u8 req, + const u16 offset, const u32 val) +{ + struct mt76x0_dev *mdev = dev; + int ret; + + mutex_lock(&mdev->usb_ctrl_mtx); + + ret = mt76x0_vendor_request(dev, req, USB_DIR_OUT, + val & 0xffff, offset, NULL, 0); + if (!ret) + ret = mt76x0_vendor_request(dev, req, USB_DIR_OUT, + val >> 16, offset + 2, NULL, 0); + + mutex_unlock(&mdev->usb_ctrl_mtx); + + return ret; +} + +static void mt76x0_wr(struct mt76_dev *dev, u32 offset, u32 val) +{ + struct mt76x0_dev *mdev = (struct mt76x0_dev *) dev; + int ret; + + WARN_ONCE(offset > USHRT_MAX, "write high off:%08x", offset); + + mutex_lock(&mdev->usb_ctrl_mtx); + + put_unaligned_le32(val, mdev->data); + ret = mt76x0_vendor_request(mdev, MT_VEND_MULTI_WRITE, USB_DIR_OUT, + 0, offset, mdev->data, MT_VEND_BUF); + trace_reg_write(dev, offset, val); + + mutex_unlock(&mdev->usb_ctrl_mtx); +} + +static u32 mt76x0_rmw(struct mt76_dev *dev, u32 offset, u32 mask, u32 val) +{ + val |= mt76x0_rr(dev, offset) & ~mask; + mt76x0_wr(dev, offset, val); + return val; +} + +static void mt76x0_wr_copy(struct mt76_dev *dev, u32 offset, + const void *data, int len) +{ + WARN_ONCE(offset & 3, "unaligned write copy off:%08x", offset); + WARN_ONCE(len & 3, "short write copy off:%08x", offset); + + mt76x0_burst_write_regs((struct mt76x0_dev *) dev, offset, data, len / 4); +} + +void mt76x0_addr_wr(struct mt76x0_dev *dev, const u32 offset, const u8 *addr) +{ + mt76_wr(dev, offset, get_unaligned_le32(addr)); + mt76_wr(dev, offset + 4, addr[4] | addr[5] << 8); +} + +static int mt76x0_assign_pipes(struct usb_interface *usb_intf, + struct mt76x0_dev *dev) +{ + struct usb_endpoint_descriptor *ep_desc; + struct usb_host_interface *intf_desc = usb_intf->cur_altsetting; + unsigned i, ep_i = 0, ep_o = 0; + + BUILD_BUG_ON(sizeof(dev->in_ep) < __MT_EP_IN_MAX); + BUILD_BUG_ON(sizeof(dev->out_ep) < __MT_EP_OUT_MAX); + + for (i = 0; i < intf_desc->desc.bNumEndpoints; i++) { + ep_desc = &intf_desc->endpoint[i].desc; + + if (usb_endpoint_is_bulk_in(ep_desc) && + ep_i++ < __MT_EP_IN_MAX) { + dev->in_ep[ep_i - 1] = usb_endpoint_num(ep_desc); + dev->in_max_packet = usb_endpoint_maxp(ep_desc); + /* Note: this is ignored by usb sub-system but vendor + * code does it. We can drop this at some point. + */ + dev->in_ep[ep_i - 1] |= USB_DIR_IN; + } else if (usb_endpoint_is_bulk_out(ep_desc) && + ep_o++ < __MT_EP_OUT_MAX) { + dev->out_ep[ep_o - 1] = usb_endpoint_num(ep_desc); + dev->out_max_packet = usb_endpoint_maxp(ep_desc); + } + } + + if (ep_i != __MT_EP_IN_MAX || ep_o != __MT_EP_OUT_MAX) { + dev_err(dev->mt76.dev, "Error: wrong pipe number in:%d out:%d\n", + ep_i, ep_o); + return -EINVAL; + } + + return 0; +} + +static int mt76x0_probe(struct usb_interface *usb_intf, + const struct usb_device_id *id) +{ + struct usb_device *usb_dev = interface_to_usbdev(usb_intf); + struct mt76x0_dev *dev; + u32 asic_rev, mac_rev; + int ret; + static const struct mt76_bus_ops usb_ops = { + .rr = mt76x0_rr, + .wr = mt76x0_wr, + .rmw = mt76x0_rmw, + .copy = mt76x0_wr_copy, + }; + + dev = mt76x0_alloc_device(&usb_intf->dev); + if (!dev) + return -ENOMEM; + + usb_dev = usb_get_dev(usb_dev); + usb_reset_device(usb_dev); + + usb_set_intfdata(usb_intf, dev); + + dev->mt76.bus = &usb_ops; + + ret = mt76x0_assign_pipes(usb_intf, dev); + if (ret) + goto err; + ret = mt76x0_wait_asic_ready(dev); + if (ret) + goto err; + + asic_rev = mt76_rr(dev, MT_ASIC_VERSION); + mac_rev = mt76_rr(dev, MT_MAC_CSR0); + dev_info(dev->mt76.dev, "ASIC revision: %08x MAC revision: %08x\n", + asic_rev, mac_rev); + + /* Note: vendor driver skips this check for MT76X0U */ + if (!(mt76_rr(dev, MT_EFUSE_CTRL) & MT_EFUSE_CTRL_SEL)) + dev_warn(dev->mt76.dev, "Warning: eFUSE not present\n"); + + ret = mt76x0_init_hardware(dev); + if (ret) + goto err; + + ret = mt76x0_register_device(dev); + if (ret) + goto err_hw; + + set_bit(MT76_STATE_INITIALIZED, &dev->mt76.state); + + return 0; +err_hw: + mt76x0_cleanup(dev); +err: + usb_set_intfdata(usb_intf, NULL); + usb_put_dev(interface_to_usbdev(usb_intf)); + + destroy_workqueue(dev->stat_wq); + ieee80211_free_hw(dev->mt76.hw); + return ret; +} + +static void mt76x0_disconnect(struct usb_interface *usb_intf) +{ + struct mt76x0_dev *dev = usb_get_intfdata(usb_intf); + bool initalized = test_bit(MT76_STATE_INITIALIZED, &dev->mt76.state); + + if (!initalized) + return; + + ieee80211_unregister_hw(dev->mt76.hw); + mt76x0_cleanup(dev); + + usb_set_intfdata(usb_intf, NULL); + usb_put_dev(interface_to_usbdev(usb_intf)); + + destroy_workqueue(dev->stat_wq); + ieee80211_free_hw(dev->mt76.hw); +} + +static int mt76x0_suspend(struct usb_interface *usb_intf, pm_message_t state) +{ + struct mt76x0_dev *dev = usb_get_intfdata(usb_intf); + + mt76x0_cleanup(dev); + + return 0; +} + +static int mt76x0_resume(struct usb_interface *usb_intf) +{ + struct mt76x0_dev *dev = usb_get_intfdata(usb_intf); + int ret; + + ret = mt76x0_init_hardware(dev); + if (ret) + return ret; + + set_bit(MT76_STATE_INITIALIZED, &dev->mt76.state); + + return 0; +} + +MODULE_DEVICE_TABLE(usb, mt76x0_device_table); +MODULE_FIRMWARE(MT7610_FIRMWARE); +MODULE_LICENSE("GPL"); + +static struct usb_driver mt76x0_driver = { + .name = KBUILD_MODNAME, + .id_table = mt76x0_device_table, + .probe = mt76x0_probe, + .disconnect = mt76x0_disconnect, + .suspend = mt76x0_suspend, + .resume = mt76x0_resume, + .reset_resume = mt76x0_resume, + .soft_unbind = 1, + .disable_hub_initiated_lpm = 1, +}; +module_usb_driver(mt76x0_driver); diff --git a/drivers/net/wireless/mediatek/mt76/mt76x0/usb.h b/drivers/net/wireless/mediatek/mt76/mt76x0/usb.h new file mode 100644 index 000000000000..9e42dfa665de --- /dev/null +++ b/drivers/net/wireless/mediatek/mt76/mt76x0/usb.h @@ -0,0 +1,61 @@ +/* + * Copyright (C) 2015 Jakub Kicinski <kubakici@wp.pl> + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 + * as published by the Free Software Foundation + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + */ + +#ifndef __MT76X0U_USB_H +#define __MT76X0U_USB_H + +#include "mt76x0.h" + +#define MT7610_FIRMWARE "mt7610.bin" + +#define MT_VEND_REQ_MAX_RETRY 10 +#define MT_VEND_REQ_TOUT_MS 300 + +#define MT_VEND_DEV_MODE_RESET 1 + +#define MT_VEND_BUF sizeof(__le32) + +static inline struct usb_device *mt76x0_to_usb_dev(struct mt76x0_dev *mt76x0) +{ + return interface_to_usbdev(to_usb_interface(mt76x0->mt76.dev)); +} + +static inline struct usb_device *mt76_to_usb_dev(struct mt76_dev *mt76) +{ + return interface_to_usbdev(to_usb_interface(mt76->dev)); +} + +static inline bool mt76x0_urb_has_error(struct urb *urb) +{ + return urb->status && + urb->status != -ENOENT && + urb->status != -ECONNRESET && + urb->status != -ESHUTDOWN; +} + +bool mt76x0_usb_alloc_buf(struct mt76x0_dev *dev, size_t len, + struct mt76x0_dma_buf *buf); +void mt76x0_usb_free_buf(struct mt76x0_dev *dev, struct mt76x0_dma_buf *buf); +int mt76x0_usb_submit_buf(struct mt76x0_dev *dev, int dir, int ep_idx, + struct mt76x0_dma_buf *buf, gfp_t gfp, + usb_complete_t complete_fn, void *context); +void mt76x0_complete_urb(struct urb *urb); + +int mt76x0_vendor_request(struct mt76x0_dev *dev, const u8 req, + const u8 direction, const u16 val, const u16 offset, + void *buf, const size_t buflen); +void mt76x0_vendor_reset(struct mt76x0_dev *dev); +int mt76x0_vendor_single_wr(struct mt76x0_dev *dev, const u8 req, + const u16 offset, const u32 val); + +#endif
Add usb files of mt76x0 driver. Signed-off-by: Stanislaw Gruszka <sgruszka@redhat.com> --- drivers/net/wireless/mediatek/mt76/mt76x0/usb.c | 377 ++++++++++++++++++++++++ drivers/net/wireless/mediatek/mt76/mt76x0/usb.h | 61 ++++ 2 files changed, 438 insertions(+) create mode 100644 drivers/net/wireless/mediatek/mt76/mt76x0/usb.c create mode 100644 drivers/net/wireless/mediatek/mt76/mt76x0/usb.h