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