Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 1 | #include "board.h" |
| 2 | #include "llist_irqsafe.h" |
| 3 | #include "usb_buf.h" |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 4 | #include "utils.h" |
Harald Welte | 7abdb51 | 2016-03-03 17:48:32 +0100 | [diff] [blame] | 5 | |
Harald Welte | 9d90d28 | 2018-06-29 22:25:42 +0200 | [diff] [blame] | 6 | #include <osmocom/core/linuxlist.h> |
| 7 | #include <osmocom/core/msgb.h> |
Harald Welte | 3d27c84 | 2016-03-17 20:07:45 +0100 | [diff] [blame] | 8 | #include <errno.h> |
| 9 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 10 | /*********************************************************************** |
| 11 | * USBD Integration API |
| 12 | ***********************************************************************/ |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 13 | |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 14 | /* call-back after (successful?) transfer of a buffer */ |
| 15 | static void usb_write_cb(uint8_t *arg, uint8_t status, uint32_t transferred, |
| 16 | uint32_t remaining) |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 17 | { |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 18 | struct msgb *msg = (struct msgb *) arg; |
| 19 | struct usb_buffered_ep *bep = msg->dst; |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 20 | unsigned long x; |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 21 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 22 | TRACE_DEBUG("%s (EP=0x%02x)\r\n", __func__, bep->ep); |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 23 | |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 24 | local_irq_save(x); |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 25 | bep->in_progress--; |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 26 | local_irq_restore(x); |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 27 | TRACE_DEBUG("%u: in_progress=%d\n", bep->ep, bep->in_progress); |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 28 | |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 29 | if (status != USBD_STATUS_SUCCESS) |
| 30 | TRACE_ERROR("%s error, status=%d\n", __func__, status); |
| 31 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 32 | usb_buf_free(msg); |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 33 | } |
| 34 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 35 | int usb_refill_to_host(uint8_t ep) |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 36 | { |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 37 | struct usb_buffered_ep *bep = usb_get_buf_ep(ep); |
| 38 | struct msgb *msg; |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 39 | unsigned long x; |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 40 | int rc; |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 41 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 42 | #if 0 |
| 43 | if (bep->out_from_host) { |
| 44 | TRACE_ERROR("EP 0x%02x is not IN\r\n", bep->ep); |
| 45 | return -EINVAL; |
| 46 | } |
| 47 | #endif |
| 48 | |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 49 | local_irq_save(x); |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 50 | if (bep->in_progress) { |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 51 | local_irq_restore(x); |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 52 | return 0; |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 53 | } |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 54 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 55 | if (llist_empty(&bep->queue)) { |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 56 | local_irq_restore(x); |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 57 | return 0; |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 58 | } |
| 59 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 60 | bep->in_progress++; |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 61 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 62 | msg = msgb_dequeue(&bep->queue); |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 63 | |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 64 | local_irq_restore(x); |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 65 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 66 | TRACE_DEBUG("%s (EP=0x%02x), in_progress=%d\r\n", __func__, ep, bep->in_progress); |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 67 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 68 | msg->dst = bep; |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 69 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 70 | rc = USBD_Write(ep, msgb_data(msg), msgb_length(msg), |
| 71 | (TransferCallback) &usb_write_cb, msg); |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 72 | if (rc != USBD_STATUS_SUCCESS) { |
Harald Welte | 2ad0ca1 | 2016-02-29 10:07:16 +0100 | [diff] [blame] | 73 | TRACE_ERROR("%s error %x\n", __func__, rc); |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 74 | /* re-insert to head of queue */ |
| 75 | llist_add_irqsafe(&msg->list, &bep->queue); |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 76 | local_irq_save(x); |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 77 | bep->in_progress--; |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 78 | local_irq_restore(x); |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 79 | TRACE_DEBUG("%02x: in_progress=%d\n", bep->ep, bep->in_progress); |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 80 | return 0; |
| 81 | } |
| 82 | |
| 83 | return 1; |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 84 | } |
| 85 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 86 | /* call-back after (successful?) transfer of a buffer */ |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 87 | static void usb_read_cb(uint8_t *arg, uint8_t status, uint32_t transferred, |
| 88 | uint32_t remaining) |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 89 | { |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 90 | struct msgb *msg = (struct msgb *) arg; |
| 91 | struct usb_buffered_ep *bep = msg->dst; |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 92 | |
Harald Welte | 53079bb | 2016-03-20 14:58:35 +0100 | [diff] [blame] | 93 | TRACE_DEBUG("%s (EP=%u, len=%u, q=%p)\r\n", __func__, |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 94 | bep->ep, transferred, &bep->queue); |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 95 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 96 | bep->in_progress = 0; |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 97 | |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 98 | if (status != USBD_STATUS_SUCCESS) { |
| 99 | TRACE_ERROR("%s error, status=%d\n", __func__, status); |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 100 | usb_buf_free(msg); |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 101 | return; |
| 102 | } |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 103 | msgb_put(msg, transferred); |
| 104 | llist_add_tail_irqsafe(&msg->list, &bep->queue); |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 105 | } |
| 106 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 107 | int usb_refill_from_host(uint8_t ep) |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 108 | { |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 109 | struct usb_buffered_ep *bep = usb_get_buf_ep(ep); |
| 110 | struct msgb *msg; |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 111 | unsigned long x; |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 112 | int rc; |
| 113 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 114 | #if 0 |
| 115 | if (!bep->out_from_host) { |
| 116 | TRACE_ERROR("EP 0x%02x is not OUT\r\n", bep->ep); |
| 117 | return -EINVAL; |
| 118 | } |
| 119 | #endif |
| 120 | |
| 121 | if (bep->in_progress) |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 122 | return 0; |
| 123 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 124 | TRACE_DEBUG("%s (EP=0x%02x)\r\n", __func__, bep->ep); |
Harald Welte | a0cf200 | 2016-03-02 10:35:51 +0100 | [diff] [blame] | 125 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 126 | msg = usb_buf_alloc(bep->ep); |
| 127 | if (!msg) |
Harald Welte | 3d27c84 | 2016-03-17 20:07:45 +0100 | [diff] [blame] | 128 | return -ENOMEM; |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 129 | msg->dst = bep; |
| 130 | msg->l1h = msg->head; |
Harald Welte | 3d27c84 | 2016-03-17 20:07:45 +0100 | [diff] [blame] | 131 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 132 | bep->in_progress = 1; |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 133 | |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 134 | rc = USBD_Read(ep, msg->head, msgb_tailroom(msg), |
| 135 | (TransferCallback) &usb_read_cb, msg); |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 136 | if (rc != USBD_STATUS_SUCCESS) { |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 137 | TRACE_ERROR("%s error %s\n", __func__, rc); |
| 138 | usb_buf_free(msg); |
| 139 | bep->in_progress = 0; |
Harald Welte | 2a6d3af | 2016-02-28 19:29:14 +0100 | [diff] [blame] | 140 | } |
| 141 | |
Harald Welte | 54cb3d0 | 2016-02-29 14:12:40 +0100 | [diff] [blame] | 142 | return 1; |
Christina Quast | 2b8a18b | 2015-04-12 09:31:36 +0200 | [diff] [blame] | 143 | } |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 144 | |
| 145 | int usb_drain_queue(uint8_t ep) |
| 146 | { |
| 147 | struct usb_buffered_ep *bep = usb_get_buf_ep(ep); |
| 148 | struct msgb *msg; |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 149 | unsigned long x; |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 150 | int ret = 0; |
| 151 | |
| 152 | /* wait until no transfers are in progress anymore and block |
| 153 | * further interrupts */ |
| 154 | while (1) { |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 155 | local_irq_save(x); |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 156 | if (!bep->in_progress) { |
| 157 | break; |
| 158 | } |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 159 | local_irq_restore(x); |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 160 | /* retry */ |
| 161 | } |
| 162 | |
| 163 | /* free all queued msgbs */ |
| 164 | while ((msg = msgb_dequeue(&bep->queue))) { |
| 165 | usb_buf_free(msg); |
| 166 | ret++; |
| 167 | } |
| 168 | |
| 169 | /* re-enable interrupts and return number of free'd msgbs */ |
Harald Welte | 119624f | 2017-11-04 12:28:30 +0100 | [diff] [blame] | 170 | local_irq_restore(x); |
Harald Welte | 8e7fca3 | 2017-05-07 16:14:33 +0200 | [diff] [blame] | 171 | |
| 172 | return ret; |
| 173 | } |