source: mainline/uspace/drv/bus/usb/vhc/transfer.c@ ad22fa4

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since ad22fa4 was feeac0d, checked in by Jiri Svoboda <jiri@…>, 12 years ago

Simplify use of list_foreach.
  • Property mode set to 100644
File size: 8.3 KB
Line 
1/*
2 * Copyright (c) 2011 Vojtech Horky
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 *
9 * - Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * - Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * - The name of the author may not be used to endorse or promote products
15 * derived from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29#include <errno.h>
30#include <str_error.h>
31#include <usbvirt/device.h>
32#include <usbvirt/ipc.h>
33#include "vhcd.h"
34
35vhc_transfer_t *vhc_transfer_create(usb_address_t address, usb_endpoint_t ep,
36 usb_direction_t dir, usb_transfer_type_t tr_type,
37 ddf_fun_t *fun, void *callback_arg)
38{
39 vhc_transfer_t *result = malloc(sizeof(vhc_transfer_t));
40 if (result == NULL) {
41 return NULL;
42 }
43 link_initialize(&result->link);
44 result->address = address;
45 result->endpoint = ep;
46 result->direction = dir;
47 result->transfer_type = tr_type;
48 result->setup_buffer = NULL;
49 result->setup_buffer_size = 0;
50 result->data_buffer = NULL;
51 result->data_buffer_size = 0;
52 result->ddf_fun = fun;
53 result->callback_arg = callback_arg;
54 result->callback_in = NULL;
55 result->callback_out = NULL;
56
57 usb_log_debug2("Created transfer %p (%d.%d %s %s)\n", result,
58 address, ep, usb_str_transfer_type_short(tr_type),
59 dir == USB_DIRECTION_IN ? "in" : "out");
60
61 return result;
62}
63
64static bool is_set_address_transfer(vhc_transfer_t *transfer)
65{
66 if (transfer->endpoint != 0) {
67 return false;
68 }
69 if (transfer->transfer_type != USB_TRANSFER_CONTROL) {
70 return false;
71 }
72 if (transfer->direction != USB_DIRECTION_OUT) {
73 return false;
74 }
75 if (transfer->setup_buffer_size != sizeof(usb_device_request_setup_packet_t)) {
76 return false;
77 }
78 usb_device_request_setup_packet_t *setup = transfer->setup_buffer;
79 if (setup->request_type != 0) {
80 return false;
81 }
82 if (setup->request != USB_DEVREQ_SET_ADDRESS) {
83 return false;
84 }
85
86 return true;
87}
88
89int vhc_virtdev_add_transfer(vhc_data_t *vhc, vhc_transfer_t *transfer)
90{
91 fibril_mutex_lock(&vhc->guard);
92
93 bool target_found = false;
94 list_foreach(vhc->devices, link, vhc_virtdev_t, dev) {
95 fibril_mutex_lock(&dev->guard);
96 if (dev->address == transfer->address) {
97 if (target_found) {
98 usb_log_warning("Transfer would be accepted by more devices!\n");
99 goto next;
100 }
101 target_found = true;
102 list_append(&transfer->link, &dev->transfer_queue);
103 }
104next:
105 fibril_mutex_unlock(&dev->guard);
106 }
107
108 fibril_mutex_unlock(&vhc->guard);
109
110 if (target_found) {
111 return EOK;
112 } else {
113 return ENOENT;
114 }
115}
116
117static int process_transfer_local(vhc_transfer_t *transfer,
118 usbvirt_device_t *dev, size_t *actual_data_size)
119{
120 int rc;
121
122 if (transfer->transfer_type == USB_TRANSFER_CONTROL) {
123 if (transfer->direction == USB_DIRECTION_IN) {
124 rc = usbvirt_control_read(dev,
125 transfer->setup_buffer, transfer->setup_buffer_size,
126 transfer->data_buffer, transfer->data_buffer_size,
127 actual_data_size);
128 } else {
129 assert(transfer->direction == USB_DIRECTION_OUT);
130 rc = usbvirt_control_write(dev,
131 transfer->setup_buffer, transfer->setup_buffer_size,
132 transfer->data_buffer, transfer->data_buffer_size);
133 }
134 } else {
135 if (transfer->direction == USB_DIRECTION_IN) {
136 rc = usbvirt_data_in(dev, transfer->transfer_type,
137 transfer->endpoint,
138 transfer->data_buffer, transfer->data_buffer_size,
139 actual_data_size);
140 } else {
141 assert(transfer->direction == USB_DIRECTION_OUT);
142 rc = usbvirt_data_out(dev, transfer->transfer_type,
143 transfer->endpoint,
144 transfer->data_buffer, transfer->data_buffer_size);
145 }
146 }
147
148 return rc;
149}
150
151static int process_transfer_remote(vhc_transfer_t *transfer,
152 async_sess_t *sess, size_t *actual_data_size)
153{
154 int rc;
155
156 if (transfer->transfer_type == USB_TRANSFER_CONTROL) {
157 if (transfer->direction == USB_DIRECTION_IN) {
158 rc = usbvirt_ipc_send_control_read(sess,
159 transfer->setup_buffer, transfer->setup_buffer_size,
160 transfer->data_buffer, transfer->data_buffer_size,
161 actual_data_size);
162 } else {
163 assert(transfer->direction == USB_DIRECTION_OUT);
164 rc = usbvirt_ipc_send_control_write(sess,
165 transfer->setup_buffer, transfer->setup_buffer_size,
166 transfer->data_buffer, transfer->data_buffer_size);
167 }
168 } else {
169 if (transfer->direction == USB_DIRECTION_IN) {
170 rc = usbvirt_ipc_send_data_in(sess, transfer->endpoint,
171 transfer->transfer_type,
172 transfer->data_buffer, transfer->data_buffer_size,
173 actual_data_size);
174 } else {
175 assert(transfer->direction == USB_DIRECTION_OUT);
176 rc = usbvirt_ipc_send_data_out(sess, transfer->endpoint,
177 transfer->transfer_type,
178 transfer->data_buffer, transfer->data_buffer_size);
179 }
180 }
181
182 return rc;
183}
184
185static vhc_transfer_t *dequeue_first_transfer(vhc_virtdev_t *dev)
186{
187 assert(fibril_mutex_is_locked(&dev->guard));
188 assert(!list_empty(&dev->transfer_queue));
189
190 vhc_transfer_t *transfer = list_get_instance(
191 list_first(&dev->transfer_queue), vhc_transfer_t, link);
192 list_remove(&transfer->link);
193
194 return transfer;
195}
196
197
198static void execute_transfer_callback_and_free(vhc_transfer_t *transfer,
199 size_t data_transfer_size, int outcome)
200{
201 assert(outcome != ENAK);
202
203 usb_log_debug2("Transfer %p ended: %s.\n",
204 transfer, str_error(outcome));
205
206 if (transfer->direction == USB_DIRECTION_IN) {
207 transfer->callback_in(transfer->ddf_fun, outcome,
208 data_transfer_size, transfer->callback_arg);
209 } else {
210 assert(transfer->direction == USB_DIRECTION_OUT);
211 transfer->callback_out(transfer->ddf_fun, outcome,
212 transfer->callback_arg);
213 }
214
215 free(transfer);
216}
217
218int vhc_transfer_queue_processor(void *arg)
219{
220 vhc_virtdev_t *dev = arg;
221 fibril_mutex_lock(&dev->guard);
222 while (dev->plugged) {
223 if (list_empty(&dev->transfer_queue)) {
224 fibril_mutex_unlock(&dev->guard);
225 async_usleep(10 * 1000);
226 fibril_mutex_lock(&dev->guard);
227 continue;
228 }
229
230 vhc_transfer_t *transfer = dequeue_first_transfer(dev);
231 fibril_mutex_unlock(&dev->guard);
232
233 int rc = EOK;
234 size_t data_transfer_size = 0;
235 if (dev->dev_sess) {
236 rc = process_transfer_remote(transfer, dev->dev_sess,
237 &data_transfer_size);
238 } else if (dev->dev_local != NULL) {
239 rc = process_transfer_local(transfer, dev->dev_local,
240 &data_transfer_size);
241 } else {
242 usb_log_warning("Device has no remote phone nor local node.\n");
243 rc = ESTALL;
244 }
245
246 usb_log_debug2("Transfer %p processed: %s.\n",
247 transfer, str_error(rc));
248
249 fibril_mutex_lock(&dev->guard);
250 if (rc == EOK) {
251 if (is_set_address_transfer(transfer)) {
252 usb_device_request_setup_packet_t *setup
253 = transfer->setup_buffer;
254 dev->address = setup->value;
255 usb_log_debug2("Address changed to %d\n",
256 dev->address);
257 }
258 }
259 if (rc == ENAK) {
260 // FIXME: this will work only because we do
261 // not NAK control transfers but this is generally
262 // a VERY bad idea indeed
263 list_append(&transfer->link, &dev->transfer_queue);
264 }
265 fibril_mutex_unlock(&dev->guard);
266
267 if (rc != ENAK) {
268 execute_transfer_callback_and_free(transfer,
269 data_transfer_size, rc);
270 }
271
272 async_usleep(1000 * 100);
273 fibril_mutex_lock(&dev->guard);
274 }
275
276 /* Immediately fail all remaining transfers. */
277 while (!list_empty(&dev->transfer_queue)) {
278 vhc_transfer_t *transfer = dequeue_first_transfer(dev);
279 execute_transfer_callback_and_free(transfer, 0, EBADCHECKSUM);
280 }
281
282 fibril_mutex_unlock(&dev->guard);
283
284 return EOK;
285}
286
Note: See TracBrowser for help on using the repository browser.