ext4: reduce contention on s_orphan_lock
[linux/fpc-iii.git] / drivers / staging / vt6656 / usbpipe.c
blobc5838d99f89f2583422b89fe9d0d325183f3971a
1 /*
2 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
3 * All rights reserved.
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.
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.
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
20 * File: usbpipe.c
22 * Purpose: Handle USB control endpoint
24 * Author: Warren Hsu
26 * Date: Mar. 29, 2005
28 * Functions:
29 * CONTROLnsRequestOut - Write variable length bytes to MEM/BB/MAC/EEPROM
30 * CONTROLnsRequestIn - Read variable length bytes from MEM/BB/MAC/EEPROM
31 * ControlvWriteByte - Write one byte to MEM/BB/MAC/EEPROM
32 * ControlvReadByte - Read one byte from MEM/BB/MAC/EEPROM
33 * ControlvMaskByte - Read one byte from MEM/BB/MAC/EEPROM and clear/set some bits in the same address
35 * Revision History:
36 * 04-05-2004 Jerry Chen: Initial release
37 * 11-24-2004 Warren Hsu: Add ControlvWriteByte,ControlvReadByte,ControlvMaskByte
41 #include "int.h"
42 #include "rxtx.h"
43 #include "dpc.h"
44 #include "control.h"
45 #include "desc.h"
46 #include "device.h"
48 //endpoint def
49 //endpoint 0: control
50 //endpoint 1: interrupt
51 //endpoint 2: read bulk
52 //endpoint 3: write bulk
54 //static int msglevel =MSG_LEVEL_DEBUG;
55 static int msglevel =MSG_LEVEL_INFO;
57 #define USB_CTL_WAIT 500 //ms
59 #ifndef URB_ASYNC_UNLINK
60 #define URB_ASYNC_UNLINK 0
61 #endif
63 static void s_nsInterruptUsbIoCompleteRead(struct urb *urb);
64 static void s_nsBulkInUsbIoCompleteRead(struct urb *urb);
65 static void s_nsBulkOutIoCompleteWrite(struct urb *urb);
66 static void s_nsControlInUsbIoCompleteRead(struct urb *urb);
67 static void s_nsControlInUsbIoCompleteWrite(struct urb *urb);
69 int PIPEnsControlOutAsyn(struct vnt_private *pDevice, u8 byRequest,
70 u16 wValue, u16 wIndex, u16 wLength, u8 *pbyBuffer)
72 int ntStatus;
74 if (pDevice->Flags & fMP_DISCONNECTED)
75 return STATUS_FAILURE;
77 if (pDevice->Flags & fMP_CONTROL_WRITES)
78 return STATUS_FAILURE;
80 if (in_interrupt()) {
81 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"in_interrupt return ..byRequest %x\n", byRequest);
82 return STATUS_FAILURE;
85 ntStatus = usb_control_msg(
86 pDevice->usb,
87 usb_sndctrlpipe(pDevice->usb , 0),
88 byRequest,
89 0x40, // RequestType
90 wValue,
91 wIndex,
92 (void *) pbyBuffer,
93 wLength,
96 if (ntStatus >= 0) {
97 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"usb_sndctrlpipe ntStatus= %d\n", ntStatus);
98 ntStatus = 0;
99 } else {
100 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"usb_sndctrlpipe fail, ntStatus= %d\n", ntStatus);
103 return ntStatus;
106 int PIPEnsControlOut(struct vnt_private *pDevice, u8 byRequest, u16 wValue,
107 u16 wIndex, u16 wLength, u8 *pbyBuffer)
108 __releases(&pDevice->lock)
109 __acquires(&pDevice->lock)
111 int ntStatus = 0;
112 int ii;
114 if (pDevice->Flags & fMP_DISCONNECTED)
115 return STATUS_FAILURE;
117 if (pDevice->Flags & fMP_CONTROL_WRITES)
118 return STATUS_FAILURE;
120 if (pDevice->Flags & fMP_CONTROL_READS)
121 return STATUS_FAILURE;
123 if (pDevice->pControlURB->hcpriv)
124 return STATUS_FAILURE;
126 MP_SET_FLAG(pDevice, fMP_CONTROL_WRITES);
128 pDevice->sUsbCtlRequest.bRequestType = 0x40;
129 pDevice->sUsbCtlRequest.bRequest = byRequest;
130 pDevice->sUsbCtlRequest.wValue = cpu_to_le16p(&wValue);
131 pDevice->sUsbCtlRequest.wIndex = cpu_to_le16p(&wIndex);
132 pDevice->sUsbCtlRequest.wLength = cpu_to_le16p(&wLength);
133 pDevice->pControlURB->transfer_flags |= URB_ASYNC_UNLINK;
134 pDevice->pControlURB->actual_length = 0;
135 // Notice, pbyBuffer limited point to variable buffer, can't be constant.
136 usb_fill_control_urb(pDevice->pControlURB, pDevice->usb,
137 usb_sndctrlpipe(pDevice->usb , 0), (char *) &pDevice->sUsbCtlRequest,
138 pbyBuffer, wLength, s_nsControlInUsbIoCompleteWrite, pDevice);
140 ntStatus = usb_submit_urb(pDevice->pControlURB, GFP_ATOMIC);
141 if (ntStatus != 0) {
142 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
143 "control send request submission failed: %d\n",
144 ntStatus);
145 MP_CLEAR_FLAG(pDevice, fMP_CONTROL_WRITES);
146 return STATUS_FAILURE;
149 spin_unlock_irq(&pDevice->lock);
150 for (ii = 0; ii <= USB_CTL_WAIT; ii ++) {
152 if (pDevice->Flags & fMP_CONTROL_WRITES)
153 mdelay(1);
154 else
155 break;
157 if (ii >= USB_CTL_WAIT) {
158 DBG_PRT(MSG_LEVEL_DEBUG,
159 KERN_INFO "control send request submission timeout\n");
160 spin_lock_irq(&pDevice->lock);
161 MP_CLEAR_FLAG(pDevice, fMP_CONTROL_WRITES);
162 return STATUS_FAILURE;
165 spin_lock_irq(&pDevice->lock);
167 return STATUS_SUCCESS;
170 int PIPEnsControlIn(struct vnt_private *pDevice, u8 byRequest, u16 wValue,
171 u16 wIndex, u16 wLength, u8 *pbyBuffer)
172 __releases(&pDevice->lock)
173 __acquires(&pDevice->lock)
175 int ntStatus = 0;
176 int ii;
178 if (pDevice->Flags & fMP_DISCONNECTED)
179 return STATUS_FAILURE;
181 if (pDevice->Flags & fMP_CONTROL_READS)
182 return STATUS_FAILURE;
184 if (pDevice->Flags & fMP_CONTROL_WRITES)
185 return STATUS_FAILURE;
187 if (pDevice->pControlURB->hcpriv)
188 return STATUS_FAILURE;
190 MP_SET_FLAG(pDevice, fMP_CONTROL_READS);
192 pDevice->sUsbCtlRequest.bRequestType = 0xC0;
193 pDevice->sUsbCtlRequest.bRequest = byRequest;
194 pDevice->sUsbCtlRequest.wValue = cpu_to_le16p(&wValue);
195 pDevice->sUsbCtlRequest.wIndex = cpu_to_le16p(&wIndex);
196 pDevice->sUsbCtlRequest.wLength = cpu_to_le16p(&wLength);
197 pDevice->pControlURB->transfer_flags |= URB_ASYNC_UNLINK;
198 pDevice->pControlURB->actual_length = 0;
199 usb_fill_control_urb(pDevice->pControlURB, pDevice->usb,
200 usb_rcvctrlpipe(pDevice->usb , 0), (char *) &pDevice->sUsbCtlRequest,
201 pbyBuffer, wLength, s_nsControlInUsbIoCompleteRead, pDevice);
203 ntStatus = usb_submit_urb(pDevice->pControlURB, GFP_ATOMIC);
204 if (ntStatus != 0) {
205 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
206 "control request submission failed: %d\n", ntStatus);
207 MP_CLEAR_FLAG(pDevice, fMP_CONTROL_READS);
208 return STATUS_FAILURE;
211 spin_unlock_irq(&pDevice->lock);
212 for (ii = 0; ii <= USB_CTL_WAIT; ii ++) {
214 if (pDevice->Flags & fMP_CONTROL_READS)
215 mdelay(1);
216 else
217 break;
219 if (ii >= USB_CTL_WAIT) {
220 DBG_PRT(MSG_LEVEL_DEBUG,
221 KERN_INFO "control rcv request submission timeout\n");
222 spin_lock_irq(&pDevice->lock);
223 MP_CLEAR_FLAG(pDevice, fMP_CONTROL_READS);
224 return STATUS_FAILURE;
227 spin_lock_irq(&pDevice->lock);
229 return ntStatus;
232 static void s_nsControlInUsbIoCompleteWrite(struct urb *urb)
234 struct vnt_private *pDevice = (struct vnt_private *)urb->context;
236 pDevice = urb->context;
237 switch (urb->status) {
238 case 0:
239 break;
240 case -EINPROGRESS:
241 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"ctrl write urb status EINPROGRESS%d\n", urb->status);
242 break;
243 case -ENOENT:
244 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"ctrl write urb status ENOENT %d\n", urb->status);
245 break;
246 default:
247 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"ctrl write urb status %d\n", urb->status);
250 MP_CLEAR_FLAG(pDevice, fMP_CONTROL_WRITES);
254 * Description:
255 * Complete function of usb Control callback
257 * Parameters:
258 * In:
259 * pDevice - Pointer to the adapter
261 * Out:
262 * none
264 * Return Value: STATUS_INSUFFICIENT_RESOURCES or result of IoCallDriver
268 static void s_nsControlInUsbIoCompleteRead(struct urb *urb)
270 struct vnt_private *pDevice = (struct vnt_private *)urb->context;
272 switch (urb->status) {
273 case 0:
274 break;
275 case -EINPROGRESS:
276 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"ctrl read urb status EINPROGRESS%d\n", urb->status);
277 break;
278 case -ENOENT:
279 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"ctrl read urb status = ENOENT %d\n", urb->status);
280 break;
281 default:
282 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"ctrl read urb status %d\n", urb->status);
285 MP_CLEAR_FLAG(pDevice, fMP_CONTROL_READS);
289 * Description:
290 * Allocates an usb interrupt in irp and calls USBD.
292 * Parameters:
293 * In:
294 * pDevice - Pointer to the adapter
295 * Out:
296 * none
298 * Return Value: STATUS_INSUFFICIENT_RESOURCES or result of IoCallDriver
302 int PIPEnsInterruptRead(struct vnt_private *priv)
304 int status = STATUS_FAILURE;
306 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
307 "---->s_nsStartInterruptUsbRead()\n");
309 if (priv->int_buf.in_use == true)
310 return STATUS_FAILURE;
312 priv->int_buf.in_use = true;
314 usb_fill_int_urb(priv->pInterruptURB,
315 priv->usb,
316 usb_rcvintpipe(priv->usb, 1),
317 priv->int_buf.data_buf,
318 MAX_INTERRUPT_SIZE,
319 s_nsInterruptUsbIoCompleteRead,
320 priv,
321 priv->int_interval);
323 status = usb_submit_urb(priv->pInterruptURB, GFP_ATOMIC);
324 if (status) {
325 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
326 "Submit int URB failed %d\n", status);
327 priv->int_buf.in_use = false;
330 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
331 "<----s_nsStartInterruptUsbRead Return(%x)\n", status);
333 return status;
337 * Description:
338 * Complete function of usb interrupt in irp.
340 * Parameters:
341 * In:
342 * pDevice - Pointer to the adapter
344 * Out:
345 * none
347 * Return Value: STATUS_INSUFFICIENT_RESOURCES or result of IoCallDriver
351 static void s_nsInterruptUsbIoCompleteRead(struct urb *urb)
353 struct vnt_private *priv = urb->context;
354 int status;
356 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
357 "---->s_nsInterruptUsbIoCompleteRead\n");
359 switch (urb->status) {
360 case 0:
361 case -ETIMEDOUT:
362 break;
363 case -ECONNRESET:
364 case -ENOENT:
365 case -ESHUTDOWN:
366 priv->int_buf.in_use = false;
367 return;
368 default:
369 break;
372 status = urb->status;
374 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
375 "s_nsInterruptUsbIoCompleteRead Status %d\n", status);
377 if (status != STATUS_SUCCESS) {
378 priv->int_buf.in_use = false;
380 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
381 "IntUSBIoCompleteControl STATUS = %d\n", status);
382 } else {
383 INTnsProcessData(priv);
386 status = usb_submit_urb(priv->pInterruptURB, GFP_ATOMIC);
387 if (status) {
388 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
389 "Submit int URB failed %d\n", status);
390 } else {
391 priv->int_buf.in_use = true;
394 return;
398 * Description:
399 * Allocates an usb BulkIn irp and calls USBD.
401 * Parameters:
402 * In:
403 * pDevice - Pointer to the adapter
404 * Out:
405 * none
407 * Return Value: STATUS_INSUFFICIENT_RESOURCES or result of IoCallDriver
411 int PIPEnsBulkInUsbRead(struct vnt_private *priv, struct vnt_rcb *rcb)
413 int status = 0;
414 struct urb *urb;
416 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"---->s_nsStartBulkInUsbRead\n");
418 if (priv->Flags & fMP_DISCONNECTED)
419 return STATUS_FAILURE;
421 urb = rcb->pUrb;
422 if (rcb->skb == NULL) {
423 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"rcb->skb is null\n");
424 return status;
427 usb_fill_bulk_urb(urb,
428 priv->usb,
429 usb_rcvbulkpipe(priv->usb, 2),
430 (void *) (rcb->skb->data),
431 MAX_TOTAL_SIZE_WITH_ALL_HEADERS,
432 s_nsBulkInUsbIoCompleteRead,
433 rcb);
435 status = usb_submit_urb(urb, GFP_ATOMIC);
436 if (status != 0) {
437 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
438 "Submit Rx URB failed %d\n", status);
439 return STATUS_FAILURE ;
442 rcb->Ref = 1;
443 rcb->bBoolInUse = true;
445 return status;
449 * Description:
450 * Complete function of usb BulkIn irp.
452 * Parameters:
453 * In:
454 * pDevice - Pointer to the adapter
456 * Out:
457 * none
459 * Return Value: STATUS_INSUFFICIENT_RESOURCES or result of IoCallDriver
463 static void s_nsBulkInUsbIoCompleteRead(struct urb *urb)
465 struct vnt_rcb *rcb = urb->context;
466 struct vnt_private *priv = rcb->pDevice;
467 int re_alloc_skb = false;
469 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"---->s_nsBulkInUsbIoCompleteRead\n");
471 switch (urb->status) {
472 case 0:
473 break;
474 case -ECONNRESET:
475 case -ENOENT:
476 case -ESHUTDOWN:
477 return;
478 case -ETIMEDOUT:
479 default:
480 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
481 "BULK In failed %d\n", urb->status);
482 break;
485 if (urb->actual_length) {
486 spin_lock(&priv->lock);
488 if (RXbBulkInProcessData(priv, rcb, urb->actual_length) == true)
489 re_alloc_skb = true;
491 spin_unlock(&priv->lock);
494 rcb->Ref--;
495 if (rcb->Ref == 0) {
496 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"RxvFreeNormal %d\n",
497 priv->NumRecvFreeList);
498 spin_lock(&priv->lock);
500 RXvFreeRCB(rcb, re_alloc_skb);
502 spin_unlock(&priv->lock);
505 return;
509 * Description:
510 * Allocates an usb BulkOut irp and calls USBD.
512 * Parameters:
513 * In:
514 * pDevice - Pointer to the adapter
515 * Out:
516 * none
518 * Return Value: STATUS_INSUFFICIENT_RESOURCES or result of IoCallDriver
522 int PIPEnsSendBulkOut(struct vnt_private *priv,
523 struct vnt_usb_send_context *context)
525 int status;
526 struct urb *urb;
528 priv->bPWBitOn = false;
530 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"s_nsSendBulkOut\n");
532 if (!(MP_IS_READY(priv) && priv->Flags & fMP_POST_WRITES)) {
533 context->bBoolInUse = false;
534 return STATUS_RESOURCES;
537 urb = context->pUrb;
539 usb_fill_bulk_urb(urb,
540 priv->usb,
541 usb_sndbulkpipe(priv->usb, 3),
542 context->Data,
543 context->uBufLen,
544 s_nsBulkOutIoCompleteWrite,
545 context);
547 status = usb_submit_urb(urb, GFP_ATOMIC);
548 if (status != 0) {
549 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
550 "Submit Tx URB failed %d\n", status);
551 context->bBoolInUse = false;
552 return STATUS_FAILURE;
555 return STATUS_PENDING;
559 * Description: s_nsBulkOutIoCompleteWrite
560 * 1a) Indicate to the protocol the status of the write.
561 * 1b) Return ownership of the packet to the protocol.
563 * 2) If any more packets are queue for sending, send another packet
564 * to USBD.
565 * If the attempt to send the packet to the driver fails,
566 * return ownership of the packet to the protocol and
567 * try another packet (until one succeeds).
569 * Parameters:
570 * In:
571 * pdoUsbDevObj - pointer to the USB device object which
572 * completed the irp
573 * pIrp - the irp which was completed by the
574 * device object
575 * pContext - the context given to IoSetCompletionRoutine
576 * before calling IoCallDriver on the irp
577 * The pContext is a pointer to the USB device object.
578 * Out:
579 * none
581 * Return Value: STATUS_MORE_PROCESSING_REQUIRED - allows the completion routine
582 * (IofCompleteRequest) to stop working on the irp.
586 static void s_nsBulkOutIoCompleteWrite(struct urb *urb)
588 struct vnt_usb_send_context *context = urb->context;
589 struct vnt_private *priv = context->pDevice;
590 u8 context_type = context->type;
592 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO"---->s_nsBulkOutIoCompleteWrite\n");
594 switch (urb->status) {
595 case 0:
596 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
597 "Write %d bytes\n", context->uBufLen);
598 break;
599 case -ECONNRESET:
600 case -ENOENT:
601 case -ESHUTDOWN:
602 context->bBoolInUse = false;
603 return;
604 case -ETIMEDOUT:
605 default:
606 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
607 "BULK Out failed %d\n", urb->status);
608 break;
611 if (!netif_device_present(priv->dev))
612 return;
614 if (CONTEXT_DATA_PACKET == context_type) {
615 if (context->pPacket != NULL) {
616 dev_kfree_skb_irq(context->pPacket);
617 context->pPacket = NULL;
618 DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO
619 "tx %d bytes\n", context->uBufLen);
622 priv->dev->trans_start = jiffies;
625 if (priv->bLinkPass == true) {
626 if (netif_queue_stopped(priv->dev))
627 netif_wake_queue(priv->dev);
630 context->bBoolInUse = false;
632 return;