diff options
author | 2015-08-04 12:17:53 -0700 | |
---|---|---|
committer | 2015-08-04 15:44:42 -0700 | |
commit | 9ca8dbcc65cfc63d6f5ef3312a33184e1d726e00 (patch) | |
tree | 1c9cafbcd35f783a87880a10f85d1a060db1a563 /kernel/drivers/staging/rtl8712/usb_ops_linux.c | |
parent | 98260f3884f4a202f9ca5eabed40b1354c489b29 (diff) |
Add the rt linux 4.1.3-rt3 as base
Import the rt linux 4.1.3-rt3 as OPNFV kvm base.
It's from git://git.kernel.org/pub/scm/linux/kernel/git/rt/linux-rt-devel.git linux-4.1.y-rt and
the base is:
commit 0917f823c59692d751951bf5ea699a2d1e2f26a2
Author: Sebastian Andrzej Siewior <bigeasy@linutronix.de>
Date: Sat Jul 25 12:13:34 2015 +0200
Prepare v4.1.3-rt3
Signed-off-by: Sebastian Andrzej Siewior <bigeasy@linutronix.de>
We lose all the git history this way and it's not good. We
should apply another opnfv project repo in future.
Change-Id: I87543d81c9df70d99c5001fbdf646b202c19f423
Signed-off-by: Yunhong Jiang <yunhong.jiang@intel.com>
Diffstat (limited to 'kernel/drivers/staging/rtl8712/usb_ops_linux.c')
-rw-r--r-- | kernel/drivers/staging/rtl8712/usb_ops_linux.c | 523 |
1 files changed, 523 insertions, 0 deletions
diff --git a/kernel/drivers/staging/rtl8712/usb_ops_linux.c b/kernel/drivers/staging/rtl8712/usb_ops_linux.c new file mode 100644 index 000000000..c3a4e3f26 --- /dev/null +++ b/kernel/drivers/staging/rtl8712/usb_ops_linux.c @@ -0,0 +1,523 @@ +/****************************************************************************** + * usb_ops_linux.c + * + * Copyright(c) 2007 - 2010 Realtek Corporation. All rights reserved. + * Linux device driver for RTL8192SU + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License 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. + * + * You should have received a copy of the GNU General Public License along with + * this program; if not, write to the Free Software Foundation, Inc., + * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA + * + * Modifications for inclusion into the Linux staging tree are + * Copyright(c) 2010 Larry Finger. All rights reserved. + * + * Contact information: + * WLAN FAE <wlanfae@realtek.com> + * Larry Finger <Larry.Finger@lwfinger.net> + * + ******************************************************************************/ + +#define _HCI_OPS_OS_C_ + +#include <linux/usb.h> + +#include "osdep_service.h" +#include "drv_types.h" +#include "osdep_intf.h" +#include "usb_ops.h" + +#define RTL871X_VENQT_READ 0xc0 +#define RTL871X_VENQT_WRITE 0x40 + +struct zero_bulkout_context { + void *pbuf; + void *purb; + void *pirp; + void *padapter; +}; + +uint r8712_usb_init_intf_priv(struct intf_priv *pintfpriv) +{ + pintfpriv->piorw_urb = usb_alloc_urb(0, GFP_ATOMIC); + if (!pintfpriv->piorw_urb) + return _FAIL; + sema_init(&(pintfpriv->io_retevt), 0); + return _SUCCESS; +} + +void r8712_usb_unload_intf_priv(struct intf_priv *pintfpriv) +{ + if (pintfpriv->piorw_urb) { + usb_kill_urb(pintfpriv->piorw_urb); + usb_free_urb(pintfpriv->piorw_urb); + } +} + +static unsigned int ffaddr2pipehdl(struct dvobj_priv *pdvobj, u32 addr) +{ + unsigned int pipe = 0; + struct usb_device *pusbd = pdvobj->pusbdev; + + if (pdvobj->nr_endpoint == 11) { + switch (addr) { + case RTL8712_DMA_BKQ: + pipe = usb_sndbulkpipe(pusbd, 0x07); + break; + case RTL8712_DMA_BEQ: + pipe = usb_sndbulkpipe(pusbd, 0x06); + break; + case RTL8712_DMA_VIQ: + pipe = usb_sndbulkpipe(pusbd, 0x05); + break; + case RTL8712_DMA_VOQ: + pipe = usb_sndbulkpipe(pusbd, 0x04); + break; + case RTL8712_DMA_BCNQ: + pipe = usb_sndbulkpipe(pusbd, 0x0a); + break; + case RTL8712_DMA_BMCQ: /* HI Queue */ + pipe = usb_sndbulkpipe(pusbd, 0x0b); + break; + case RTL8712_DMA_MGTQ: + pipe = usb_sndbulkpipe(pusbd, 0x0c); + break; + case RTL8712_DMA_RX0FF: + pipe = usb_rcvbulkpipe(pusbd, 0x03); /* in */ + break; + case RTL8712_DMA_C2HCMD: + pipe = usb_rcvbulkpipe(pusbd, 0x09); /* in */ + break; + case RTL8712_DMA_H2CCMD: + pipe = usb_sndbulkpipe(pusbd, 0x0d); + break; + } + } else if (pdvobj->nr_endpoint == 6) { + switch (addr) { + case RTL8712_DMA_BKQ: + pipe = usb_sndbulkpipe(pusbd, 0x07); + break; + case RTL8712_DMA_BEQ: + pipe = usb_sndbulkpipe(pusbd, 0x06); + break; + case RTL8712_DMA_VIQ: + pipe = usb_sndbulkpipe(pusbd, 0x05); + break; + case RTL8712_DMA_VOQ: + pipe = usb_sndbulkpipe(pusbd, 0x04); + break; + case RTL8712_DMA_RX0FF: + case RTL8712_DMA_C2HCMD: + pipe = usb_rcvbulkpipe(pusbd, 0x03); /* in */ + break; + case RTL8712_DMA_H2CCMD: + case RTL8712_DMA_BCNQ: + case RTL8712_DMA_BMCQ: + case RTL8712_DMA_MGTQ: + pipe = usb_sndbulkpipe(pusbd, 0x0d); + break; + } + } else if (pdvobj->nr_endpoint == 4) { + switch (addr) { + case RTL8712_DMA_BEQ: + pipe = usb_sndbulkpipe(pusbd, 0x06); + break; + case RTL8712_DMA_VOQ: + pipe = usb_sndbulkpipe(pusbd, 0x04); + break; + case RTL8712_DMA_RX0FF: + case RTL8712_DMA_C2HCMD: + pipe = usb_rcvbulkpipe(pusbd, 0x03); /* in */ + break; + case RTL8712_DMA_H2CCMD: + case RTL8712_DMA_BCNQ: + case RTL8712_DMA_BMCQ: + case RTL8712_DMA_MGTQ: + pipe = usb_sndbulkpipe(pusbd, 0x0d); + break; + } + } else + pipe = 0; + return pipe; +} + +static void usb_write_mem_complete(struct urb *purb) +{ + struct io_queue *pio_q = (struct io_queue *)purb->context; + struct intf_hdl *pintf = &(pio_q->intf); + struct intf_priv *pintfpriv = pintf->pintfpriv; + struct _adapter *padapter = (struct _adapter *)pintf->adapter; + + if (purb->status != 0) { + if (purb->status == (-ESHUTDOWN)) + padapter->bDriverStopped = true; + else + padapter->bSurpriseRemoved = true; + } + up(&pintfpriv->io_retevt); +} + +void r8712_usb_write_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) +{ + unsigned int pipe; + struct _adapter *padapter = (struct _adapter *)pintfhdl->adapter; + struct intf_priv *pintfpriv = pintfhdl->pintfpriv; + struct io_queue *pio_queue = (struct io_queue *)padapter->pio_queue; + struct dvobj_priv *pdvobj = (struct dvobj_priv *)pintfpriv->intf_dev; + struct usb_device *pusbd = pdvobj->pusbdev; + struct urb *piorw_urb = pintfpriv->piorw_urb; + + if ((padapter->bDriverStopped) || (padapter->bSurpriseRemoved) || + (padapter->pwrctrlpriv.pnp_bstop_trx)) + return; + /* translate DMA FIFO addr to pipehandle */ + pipe = ffaddr2pipehdl(pdvobj, addr); + if (pipe == 0) + return; + usb_fill_bulk_urb(piorw_urb, pusbd, pipe, + wmem, cnt, usb_write_mem_complete, + pio_queue); + usb_submit_urb(piorw_urb, GFP_ATOMIC); + _down_sema(&pintfpriv->io_retevt); +} + +static void r8712_usb_read_port_complete(struct urb *purb) +{ + uint isevt, *pbuf; + struct recv_buf *precvbuf = (struct recv_buf *)purb->context; + struct _adapter *padapter = (struct _adapter *)precvbuf->adapter; + struct recv_priv *precvpriv = &padapter->recvpriv; + + if (padapter->bSurpriseRemoved || padapter->bDriverStopped) + return; + if (purb->status == 0) { /* SUCCESS */ + if ((purb->actual_length > (MAX_RECVBUF_SZ)) || + (purb->actual_length < RXDESC_SIZE)) { + precvbuf->reuse = true; + r8712_read_port(padapter, precvpriv->ff_hwaddr, 0, + (unsigned char *)precvbuf); + } else { + precvbuf->transfer_len = purb->actual_length; + pbuf = (uint *)precvbuf->pbuf; + isevt = le32_to_cpu(*(pbuf + 1)) & 0x1ff; + if ((isevt & 0x1ff) == 0x1ff) { + r8712_rxcmd_event_hdl(padapter, pbuf); + precvbuf->reuse = true; + r8712_read_port(padapter, precvpriv->ff_hwaddr, + 0, (unsigned char *)precvbuf); + } else { + _pkt *pskb = precvbuf->pskb; + + skb_put(pskb, purb->actual_length); + skb_queue_tail(&precvpriv->rx_skb_queue, pskb); + tasklet_hi_schedule(&precvpriv->recv_tasklet); + precvbuf->pskb = NULL; + precvbuf->reuse = false; + r8712_read_port(padapter, precvpriv->ff_hwaddr, + 0, (unsigned char *)precvbuf); + } + } + } else { + switch (purb->status) { + case -EINVAL: + case -EPIPE: + case -ENODEV: + case -ESHUTDOWN: + case -ENOENT: + padapter->bDriverStopped = true; + break; + case -EPROTO: + precvbuf->reuse = true; + r8712_read_port(padapter, precvpriv->ff_hwaddr, 0, + (unsigned char *)precvbuf); + break; + case -EINPROGRESS: + netdev_err(padapter->pnetdev, "ERROR: URB IS IN PROGRESS!\n"); + break; + default: + break; + } + } +} + +u32 r8712_usb_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) +{ + unsigned int pipe; + int err; + u32 tmpaddr = 0; + int alignment = 0; + u32 ret = _SUCCESS; + struct urb *purb = NULL; + struct recv_buf *precvbuf = (struct recv_buf *)rmem; + struct intf_priv *pintfpriv = pintfhdl->pintfpriv; + struct dvobj_priv *pdvobj = (struct dvobj_priv *)pintfpriv->intf_dev; + struct _adapter *adapter = (struct _adapter *)pdvobj->padapter; + struct recv_priv *precvpriv = &adapter->recvpriv; + struct usb_device *pusbd = pdvobj->pusbdev; + + if (adapter->bDriverStopped || adapter->bSurpriseRemoved || + adapter->pwrctrlpriv.pnp_bstop_trx) + return _FAIL; + if (!precvbuf->reuse == false || !precvbuf->pskb) { + precvbuf->pskb = skb_dequeue(&precvpriv->free_recv_skb_queue); + if (NULL != precvbuf->pskb) + precvbuf->reuse = true; + } + if (precvbuf != NULL) { + r8712_init_recvbuf(adapter, precvbuf); + /* re-assign for linux based on skb */ + if (!precvbuf->reuse || !precvbuf->pskb) { + precvbuf->pskb = netdev_alloc_skb(adapter->pnetdev, + MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ); + if (!precvbuf->pskb) + return _FAIL; + tmpaddr = (addr_t)precvbuf->pskb->data; + alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1); + skb_reserve(precvbuf->pskb, + (RECVBUFF_ALIGN_SZ - alignment)); + precvbuf->phead = precvbuf->pskb->head; + precvbuf->pdata = precvbuf->pskb->data; + precvbuf->ptail = skb_tail_pointer(precvbuf->pskb); + precvbuf->pend = skb_end_pointer(precvbuf->pskb); + precvbuf->pbuf = precvbuf->pskb->data; + } else { /* reuse skb */ + precvbuf->phead = precvbuf->pskb->head; + precvbuf->pdata = precvbuf->pskb->data; + precvbuf->ptail = skb_tail_pointer(precvbuf->pskb); + precvbuf->pend = skb_end_pointer(precvbuf->pskb); + precvbuf->pbuf = precvbuf->pskb->data; + precvbuf->reuse = false; + } + purb = precvbuf->purb; + /* translate DMA FIFO addr to pipehandle */ + pipe = ffaddr2pipehdl(pdvobj, addr); + usb_fill_bulk_urb(purb, pusbd, pipe, + precvbuf->pbuf, MAX_RECVBUF_SZ, + r8712_usb_read_port_complete, + precvbuf); + err = usb_submit_urb(purb, GFP_ATOMIC); + if ((err) && (err != (-EPERM))) + ret = _FAIL; + } else + ret = _FAIL; + return ret; +} + +void r8712_usb_read_port_cancel(struct _adapter *padapter) +{ + int i; + struct recv_buf *precvbuf; + + precvbuf = (struct recv_buf *)padapter->recvpriv.precv_buf; + for (i = 0; i < NR_RECVBUFF; i++) { + if (precvbuf->purb) + usb_kill_urb(precvbuf->purb); + precvbuf++; + } +} + +void r8712_xmit_bh(void *priv) +{ + int ret = false; + struct _adapter *padapter = (struct _adapter *)priv; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + + if ((padapter->bDriverStopped == true) || + (padapter->bSurpriseRemoved == true)) { + netdev_err(padapter->pnetdev, "xmit_bh => bDriverStopped or bSurpriseRemoved\n"); + return; + } + ret = r8712_xmitframe_complete(padapter, pxmitpriv, NULL); + if (ret == false) + return; + tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); +} + +static void usb_write_port_complete(struct urb *purb) +{ + int i; + struct xmit_frame *pxmitframe = (struct xmit_frame *)purb->context; + struct xmit_buf *pxmitbuf = pxmitframe->pxmitbuf; + struct _adapter *padapter = pxmitframe->padapter; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct pkt_attrib *pattrib = &pxmitframe->attrib; + + switch (pattrib->priority) { + case 1: + case 2: + pxmitpriv->bkq_cnt--; + break; + case 4: + case 5: + pxmitpriv->viq_cnt--; + break; + case 6: + case 7: + pxmitpriv->voq_cnt--; + break; + case 0: + case 3: + default: + pxmitpriv->beq_cnt--; + break; + } + pxmitpriv->txirp_cnt--; + for (i = 0; i < 8; i++) { + if (purb == pxmitframe->pxmit_urb[i]) { + pxmitframe->bpending[i] = false; + break; + } + } + if (padapter->bSurpriseRemoved) + return; + switch (purb->status) { + case 0: + break; + default: + netdev_warn(padapter->pnetdev, + "r8712u: pipe error: (%d)\n", purb->status); + break; + } + /* not to consider tx fragment */ + r8712_free_xmitframe_ex(pxmitpriv, pxmitframe); + r8712_free_xmitbuf(pxmitpriv, pxmitbuf); + tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); +} + +u32 r8712_usb_write_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) +{ + unsigned long irqL; + int i, status; + unsigned int pipe; + u32 ret, bwritezero; + struct urb *purb = NULL; + struct _adapter *padapter = (struct _adapter *)pintfhdl->adapter; + struct dvobj_priv *pdvobj = (struct dvobj_priv *)&padapter->dvobjpriv; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct xmit_frame *pxmitframe = (struct xmit_frame *)wmem; + struct usb_device *pusbd = pdvobj->pusbdev; + struct pkt_attrib *pattrib = &pxmitframe->attrib; + + if ((padapter->bDriverStopped) || (padapter->bSurpriseRemoved) || + (padapter->pwrctrlpriv.pnp_bstop_trx)) + return _FAIL; + for (i = 0; i < 8; i++) { + if (pxmitframe->bpending[i] == false) { + spin_lock_irqsave(&pxmitpriv->lock, irqL); + pxmitpriv->txirp_cnt++; + pxmitframe->bpending[i] = true; + switch (pattrib->priority) { + case 1: + case 2: + pxmitpriv->bkq_cnt++; + break; + case 4: + case 5: + pxmitpriv->viq_cnt++; + break; + case 6: + case 7: + pxmitpriv->voq_cnt++; + break; + case 0: + case 3: + default: + pxmitpriv->beq_cnt++; + break; + } + spin_unlock_irqrestore(&pxmitpriv->lock, irqL); + pxmitframe->sz[i] = (u16)cnt; + purb = pxmitframe->pxmit_urb[i]; + break; + } + } + bwritezero = false; + if (pdvobj->ishighspeed) { + if (cnt > 0 && cnt % 512 == 0) + bwritezero = true; + } else { + if (cnt > 0 && cnt % 64 == 0) + bwritezero = true; + } + /* translate DMA FIFO addr to pipehandle */ + pipe = ffaddr2pipehdl(pdvobj, addr); + if (pxmitpriv->free_xmitbuf_cnt%NR_XMITBUFF == 0) + purb->transfer_flags &= (~URB_NO_INTERRUPT); + else + purb->transfer_flags |= URB_NO_INTERRUPT; + if (bwritezero) + cnt += 8; + usb_fill_bulk_urb(purb, pusbd, pipe, + pxmitframe->mem_addr, + cnt, usb_write_port_complete, + pxmitframe); /* context is xmit_frame */ + status = usb_submit_urb(purb, GFP_ATOMIC); + if (!status) + ret = _SUCCESS; + else + ret = _FAIL; + return ret; +} + +void r8712_usb_write_port_cancel(struct _adapter *padapter) +{ + int i, j; + struct xmit_buf *pxmitbuf = (struct xmit_buf *) + padapter->xmitpriv.pxmitbuf; + + for (i = 0; i < NR_XMITBUFF; i++) { + for (j = 0; j < 8; j++) { + if (pxmitbuf->pxmit_urb[j]) + usb_kill_urb(pxmitbuf->pxmit_urb[j]); + } + pxmitbuf++; + } +} + +int r8712_usbctrl_vendorreq(struct intf_priv *pintfpriv, u8 request, u16 value, + u16 index, void *pdata, u16 len, u8 requesttype) +{ + unsigned int pipe; + int status; + u8 reqtype; + struct dvobj_priv *pdvobjpriv = (struct dvobj_priv *) + pintfpriv->intf_dev; + struct usb_device *udev = pdvobjpriv->pusbdev; + /* For mstar platform, mstar suggests the address for USB IO + * should be 16 bytes alignment. Trying to fix it here. + */ + u8 *palloc_buf, *pIo_buf; + + palloc_buf = kmalloc((u32)len + 16, GFP_ATOMIC); + if (palloc_buf == NULL) + return -ENOMEM; + pIo_buf = palloc_buf + 16 - ((addr_t)(palloc_buf) & 0x0f); + if (requesttype == 0x01) { + pipe = usb_rcvctrlpipe(udev, 0); /* read_in */ + reqtype = RTL871X_VENQT_READ; + } else { + pipe = usb_sndctrlpipe(udev, 0); /* write_out */ + reqtype = RTL871X_VENQT_WRITE; + memcpy(pIo_buf, pdata, len); + } + status = usb_control_msg(udev, pipe, request, reqtype, value, index, + pIo_buf, len, HZ / 2); + if (status > 0) { /* Success this control transfer. */ + if (requesttype == 0x01) { + /* For Control read transfer, we have to copy the read + * data from pIo_buf to pdata. + */ + memcpy(pdata, pIo_buf, status); + } + } + kfree(palloc_buf); + return status; +} |