Harald Welte | 7abdb51 | 2016-03-03 17:48:32 +0100 | [diff] [blame] | 1 | //#define TRACE_LEVEL 6 |
| 2 | |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 3 | #include "board.h" |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 4 | #include "req_ctx.h" |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 5 | #include "linuxlist.h" |
| 6 | |
| 7 | static volatile uint32_t usbep_in_progress[BOARD_USB_NUMENDPOINTS]; |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 8 | |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 9 | /* call-back after (successful?) transfer of a buffer */ |
| 10 | static void usb_write_cb(uint8_t *arg, uint8_t status, uint32_t transferred, |
| 11 | uint32_t remaining) |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 12 | { |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 13 | struct req_ctx *rctx = (struct req_ctx *) arg; |
| 14 | |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 15 | TRACE_DEBUG("%s (EP=%u)\r\n", __func__, rctx->ep); |
| 16 | |
| 17 | __disable_irq(); |
| 18 | usbep_in_progress[rctx->ep]--; |
| 19 | __enable_irq(); |
| 20 | TRACE_DEBUG("%u: in_progress=%d\n", rctx->ep, usbep_in_progress[rctx->ep]); |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 21 | |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 22 | if (status != USBD_STATUS_SUCCESS) |
| 23 | TRACE_ERROR("%s error, status=%d\n", __func__, status); |
| 24 | |
| 25 | /* release request contxt to pool */ |
| 26 | req_ctx_set_state(rctx, RCTX_S_FREE); |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 27 | } |
| 28 | |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 29 | int usb_refill_to_host(struct llist_head *queue, uint32_t ep) |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 30 | { |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 31 | struct req_ctx *rctx; |
| 32 | int rc; |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 33 | |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 34 | __disable_irq(); |
| 35 | if (usbep_in_progress[ep]) { |
| 36 | __enable_irq(); |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 37 | return 0; |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 38 | } |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 39 | |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 40 | if (llist_empty(queue)) { |
| 41 | __enable_irq(); |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 42 | return 0; |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 43 | } |
| 44 | |
| 45 | usbep_in_progress[ep]++; |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 46 | |
| 47 | rctx = llist_entry(queue->next, struct req_ctx, list); |
| 48 | llist_del(&rctx->list); |
| 49 | |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 50 | __enable_irq(); |
| 51 | |
| 52 | TRACE_DEBUG("%u: in_progress=%d\n", ep, usbep_in_progress[ep]); |
| 53 | TRACE_DEBUG("%s (EP=%u)\r\n", __func__, ep); |
| 54 | |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 55 | req_ctx_set_state(rctx, RCTX_S_USB_TX_BUSY); |
| 56 | rctx->ep = ep; |
| 57 | |
| 58 | rc = USBD_Write(ep, rctx->data, rctx->tot_len, |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 59 | (TransferCallback) &usb_write_cb, rctx); |
| 60 | if (rc != USBD_STATUS_SUCCESS) { |
Harald Welte | 2ad0ca1 | 2016-02-29 10:07:16 +0100 | [diff] [blame] | 61 | TRACE_ERROR("%s error %x\n", __func__, rc); |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 62 | req_ctx_set_state(rctx, RCTX_S_USB_TX_PENDING); |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 63 | __disable_irq(); |
| 64 | usbep_in_progress[ep]--; |
| 65 | __enable_irq(); |
| 66 | TRACE_DEBUG("%u: in_progress=%d\n", ep, usbep_in_progress[ep]); |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 67 | return 0; |
| 68 | } |
| 69 | |
| 70 | return 1; |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 71 | } |
| 72 | |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 73 | static void usb_read_cb(uint8_t *arg, uint8_t status, uint32_t transferred, |
| 74 | uint32_t remaining) |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 75 | { |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 76 | struct req_ctx *rctx = (struct req_ctx *) arg; |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 77 | struct llist_head *queue = (struct llist_head *) usbep_in_progress[rctx->ep]; |
| 78 | |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 79 | TRACE_DEBUG("%s (EP=%u)\r\n", __func__, rctx->ep); |
| 80 | |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 81 | usbep_in_progress[rctx->ep] = 0; |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 82 | |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 83 | if (status != USBD_STATUS_SUCCESS) { |
| 84 | TRACE_ERROR("%s error, status=%d\n", __func__, status); |
| 85 | /* release request contxt to pool */ |
| 86 | req_ctx_put(rctx); |
| 87 | return; |
| 88 | } |
Harald Welte | 250cd2c | 2016-03-17 18:19:39 +0100 | [diff] [blame^] | 89 | rctx->tot_len = transferred; |
Harald Welte | ebb80ed | 2016-03-02 13:56:59 +0100 | [diff] [blame] | 90 | req_ctx_set_state(rctx, RCTX_S_MAIN_PROCESSING); |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 91 | llist_add_tail(&rctx->list, queue); |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 92 | } |
| 93 | |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 94 | int usb_refill_from_host(struct llist_head *queue, int ep) |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 95 | { |
| 96 | struct req_ctx *rctx; |
| 97 | int rc; |
| 98 | |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 99 | if (usbep_in_progress[ep]) |
| 100 | return 0; |
| 101 | |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 102 | TRACE_DEBUG("%s (EP=%u)\r\n", __func__, ep); |
| 103 | |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 104 | rctx = req_ctx_find_get(0, RCTX_S_FREE, RCTX_S_USB_RX_BUSY); |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 105 | rctx->ep = ep; |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 106 | |
| 107 | rc = USBD_Read(ep, rctx->data, rctx->size, |
| 108 | (TransferCallback) &usb_read_cb, rctx); |
| 109 | |
| 110 | if (rc != USBD_STATUS_SUCCESS) { |
Harald Welte | 2ad0ca1 | 2016-02-29 10:07:16 +0100 | [diff] [blame] | 111 | TRACE_ERROR("%s error %x\n", __func__, rc); |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 112 | req_ctx_put(rctx); |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 113 | return 0; |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 114 | } |
| 115 | |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 116 | usbep_in_progress[ep] = (uint32_t) queue; |
| 117 | |
| 118 | return 1; |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 119 | } |