drivers/staging/vt6656/usbpipe.c

   1 /*
   2  * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
   3  * All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License as published by
   7  * the Free Software Foundation; either version 2 of the License, or
   8  * (at your option) any later version.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  *
  16  * File: usbpipe.c
  17  *
  18  * Purpose: Handle USB control endpoint
  19  *
  20  * Author: Warren Hsu
  21  *
  22  * Date: Mar. 29, 2005
  23  *
  24  * Functions:
  25  *      vnt_control_out - Write variable length bytes to MEM/BB/MAC/EEPROM
  26  *      vnt_control_in - Read variable length bytes from MEM/BB/MAC/EEPROM
  27  *      vnt_control_out_u8 - Write one byte to MEM/BB/MAC/EEPROM
  28  *      vnt_control_in_u8 - Read one byte from MEM/BB/MAC/EEPROM
  29  *
  30  * Revision History:
  31  *      04-05-2004 Jerry Chen:  Initial release
  32  *      11-24-2004 Warren Hsu: Add ControlvWriteByte,ControlvReadByte,ControlvMaskByte
  33  *
  34  */
  35
  36 #include "int.h"
  37 #include "rxtx.h"
  38 #include "dpc.h"
  39 #include "desc.h"
  40 #include "device.h"
  41 #include "usbpipe.h"
  42
  43 #define USB_CTL_WAIT    500 /* ms */
  44
  45 int vnt_control_out(struct vnt_private *priv, u8 request, u16 value,
  46                 u16 index, u16 length, u8 *buffer)
  47 {
  48         int status = 0;
  49
  50         if (test_bit(DEVICE_FLAGS_DISCONNECTED, &priv->flags))
  51                 return STATUS_FAILURE;
  52
  53         mutex_lock(&priv->usb_lock);
  54
  55         status = usb_control_msg(priv->usb,
  56                 usb_sndctrlpipe(priv->usb, 0), request, 0x40, value,
  57                         index, buffer, length, USB_CTL_WAIT);
  58
  59         mutex_unlock(&priv->usb_lock);
  60
  61         if (status < (int)length)
  62                 return STATUS_FAILURE;
  63
  64         return STATUS_SUCCESS;
  65 }
  66
  67 void vnt_control_out_u8(struct vnt_private *priv, u8 reg, u8 reg_off, u8 data)
  68 {
  69         vnt_control_out(priv, MESSAGE_TYPE_WRITE,
  70                                         reg_off, reg, sizeof(u8), &data);
  71 }
  72
  73 int vnt_control_in(struct vnt_private *priv, u8 request, u16 value,
  74                 u16 index, u16 length, u8 *buffer)
  75 {
  76         int status;
  77
  78         if (test_bit(DEVICE_FLAGS_DISCONNECTED, &priv->flags))
  79                 return STATUS_FAILURE;
  80
  81         mutex_lock(&priv->usb_lock);
  82
  83         status = usb_control_msg(priv->usb,
  84                 usb_rcvctrlpipe(priv->usb, 0), request, 0xc0, value,
  85                         index, buffer, length, USB_CTL_WAIT);
  86
  87         mutex_unlock(&priv->usb_lock);
  88
  89         if (status < (int)length)
  90                 return STATUS_FAILURE;
  91
  92         return STATUS_SUCCESS;
  93 }
  94
  95 void vnt_control_in_u8(struct vnt_private *priv, u8 reg, u8 reg_off, u8 *data)
  96 {
  97         vnt_control_in(priv, MESSAGE_TYPE_READ,
  98                         reg_off, reg, sizeof(u8), data);
  99 }
 100
 101 static void vnt_start_interrupt_urb_complete(struct urb *urb)
 102 {
 103         struct vnt_private *priv = urb->context;
 104         int status;
 105
 106         switch (urb->status) {
 107         case 0:
 108         case -ETIMEDOUT:
 109                 break;
 110         case -ECONNRESET:
 111         case -ENOENT:
 112         case -ESHUTDOWN:
 113                 priv->int_buf.in_use = false;
 114                 return;
 115         default:
 116                 break;
 117         }
 118
 119         status = urb->status;
 120
 121         if (status != STATUS_SUCCESS) {
 122                 priv->int_buf.in_use = false;
 123
 124                 dev_dbg(&priv->usb->dev, "%s status = %d\n", __func__, status);
 125         } else {
 126                 vnt_int_process_data(priv);
 127         }
 128
 129         status = usb_submit_urb(priv->interrupt_urb, GFP_ATOMIC);
 130         if (status)
 131                 dev_dbg(&priv->usb->dev, "Submit int URB failed %d\n", status);
 132         else
 133                 priv->int_buf.in_use = true;
 134 }
 135
 136 int vnt_start_interrupt_urb(struct vnt_private *priv)
 137 {
 138         int status = STATUS_FAILURE;
 139
 140         if (priv->int_buf.in_use)
 141                 return STATUS_FAILURE;
 142
 143         priv->int_buf.in_use = true;
 144
 145         usb_fill_int_urb(priv->interrupt_urb,
 146                          priv->usb,
 147                          usb_rcvintpipe(priv->usb, 1),
 148                          priv->int_buf.data_buf,
 149                          MAX_INTERRUPT_SIZE,
 150                          vnt_start_interrupt_urb_complete,
 151                          priv,
 152                          priv->int_interval);
 153
 154         status = usb_submit_urb(priv->interrupt_urb, GFP_ATOMIC);
 155         if (status) {
 156                 dev_dbg(&priv->usb->dev, "Submit int URB failed %d\n", status);
 157                 priv->int_buf.in_use = false;
 158         }
 159
 160         return status;
 161 }
 162
 163 static void vnt_submit_rx_urb_complete(struct urb *urb)
 164 {
 165         struct vnt_rcb *rcb = urb->context;
 166         struct vnt_private *priv = rcb->priv;
 167
 168         switch (urb->status) {
 169         case 0:
 170                 break;
 171         case -ECONNRESET:
 172         case -ENOENT:
 173         case -ESHUTDOWN:
 174                 return;
 175         case -ETIMEDOUT:
 176         default:
 177                 dev_dbg(&priv->usb->dev, "BULK In failed %d\n", urb->status);
 178                 break;
 179         }
 180
 181         if (urb->actual_length) {
 182                 if (vnt_rx_data(priv, rcb, urb->actual_length)) {
 183                         rcb->skb = dev_alloc_skb(priv->rx_buf_sz);
 184                         if (!rcb->skb) {
 185                                 dev_dbg(&priv->usb->dev,
 186                                         "Failed to re-alloc rx skb\n");
 187
 188                                 rcb->in_use = false;
 189                                 return;
 190                         }
 191                 } else {
 192                         skb_push(rcb->skb, skb_headroom(rcb->skb));
 193                         skb_trim(rcb->skb, 0);
 194                 }
 195
 196                 urb->transfer_buffer = skb_put(rcb->skb,
 197                                                 skb_tailroom(rcb->skb));
 198         }
 199
 200         if (usb_submit_urb(urb, GFP_ATOMIC)) {
 201                 dev_dbg(&priv->usb->dev, "Failed to re submit rx skb\n");
 202
 203                 rcb->in_use = false;
 204         }
 205 }
 206
 207 int vnt_submit_rx_urb(struct vnt_private *priv, struct vnt_rcb *rcb)
 208 {
 209         int status = 0;
 210         struct urb *urb;
 211
 212         urb = rcb->urb;
 213         if (rcb->skb == NULL) {
 214                 dev_dbg(&priv->usb->dev, "rcb->skb is null\n");
 215                 return status;
 216         }
 217
 218         usb_fill_bulk_urb(urb,
 219                           priv->usb,
 220                           usb_rcvbulkpipe(priv->usb, 2),
 221                           skb_put(rcb->skb, skb_tailroom(rcb->skb)),
 222                           MAX_TOTAL_SIZE_WITH_ALL_HEADERS,
 223                           vnt_submit_rx_urb_complete,
 224                           rcb);
 225
 226         status = usb_submit_urb(urb, GFP_ATOMIC);
 227         if (status != 0) {
 228                 dev_dbg(&priv->usb->dev, "Submit Rx URB failed %d\n", status);
 229                 return STATUS_FAILURE;
 230         }
 231
 232         rcb->in_use = true;
 233
 234         return status;
 235 }
 236
 237 static void vnt_tx_context_complete(struct urb *urb)
 238 {
 239         struct vnt_usb_send_context *context = urb->context;
 240         struct vnt_private *priv = context->priv;
 241
 242         switch (urb->status) {
 243         case 0:
 244                 dev_dbg(&priv->usb->dev, "Write %d bytes\n", context->buf_len);
 245                 break;
 246         case -ECONNRESET:
 247         case -ENOENT:
 248         case -ESHUTDOWN:
 249                 context->in_use = false;
 250                 return;
 251         case -ETIMEDOUT:
 252         default:
 253                 dev_dbg(&priv->usb->dev, "BULK Out failed %d\n", urb->status);
 254                 break;
 255         }
 256
 257         if (context->type == CONTEXT_DATA_PACKET)
 258                 ieee80211_wake_queues(priv->hw);
 259
 260         if (urb->status || context->type == CONTEXT_BEACON_PACKET) {
 261                 if (context->skb)
 262                         ieee80211_free_txskb(priv->hw, context->skb);
 263
 264                 context->in_use = false;
 265         }
 266 }
 267
 268 int vnt_tx_context(struct vnt_private *priv,
 269                    struct vnt_usb_send_context *context)
 270 {
 271         int status;
 272         struct urb *urb;
 273
 274         if (test_bit(DEVICE_FLAGS_DISCONNECTED, &priv->flags)) {
 275                 context->in_use = false;
 276                 return STATUS_RESOURCES;
 277         }
 278
 279         urb = context->urb;
 280
 281         usb_fill_bulk_urb(urb,
 282                           priv->usb,
 283                           usb_sndbulkpipe(priv->usb, 3),
 284                           context->data,
 285                           context->buf_len,
 286                           vnt_tx_context_complete,
 287                           context);
 288
 289         status = usb_submit_urb(urb, GFP_ATOMIC);
 290         if (status != 0) {
 291                 dev_dbg(&priv->usb->dev, "Submit Tx URB failed %d\n", status);
 292
 293                 context->in_use = false;
 294                 return STATUS_FAILURE;
 295         }
 296
 297         return STATUS_PENDING;
 298 }