1 | /*
|
---|
2 | * Copyright (c) 2006 Ondrej Palkovsky
|
---|
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 | /** @addtogroup libc
|
---|
30 | * @{
|
---|
31 | */
|
---|
32 | /** @file
|
---|
33 | */
|
---|
34 |
|
---|
35 | /**
|
---|
36 | * Asynchronous library
|
---|
37 | *
|
---|
38 | * The aim of this library is to provide a facility for writing programs which
|
---|
39 | * utilize the asynchronous nature of HelenOS IPC, yet using a normal way of
|
---|
40 | * programming.
|
---|
41 | *
|
---|
42 | * You should be able to write very simple multithreaded programs. The async
|
---|
43 | * framework will automatically take care of most of the synchronization
|
---|
44 | * problems.
|
---|
45 | *
|
---|
46 | * Example of use (pseudo C):
|
---|
47 | *
|
---|
48 | * 1) Multithreaded client application
|
---|
49 | *
|
---|
50 | * fibril_create(fibril1, ...);
|
---|
51 | * fibril_create(fibril2, ...);
|
---|
52 | * ...
|
---|
53 | *
|
---|
54 | * int fibril1(void *arg)
|
---|
55 | * {
|
---|
56 | * conn = async_connect_me_to(...);
|
---|
57 | *
|
---|
58 | * exch = async_exchange_begin(conn);
|
---|
59 | * c1 = async_send(exch);
|
---|
60 | * async_exchange_end(exch);
|
---|
61 | *
|
---|
62 | * exch = async_exchange_begin(conn);
|
---|
63 | * c2 = async_send(exch);
|
---|
64 | * async_exchange_end(exch);
|
---|
65 | *
|
---|
66 | * async_wait_for(c1);
|
---|
67 | * async_wait_for(c2);
|
---|
68 | * ...
|
---|
69 | * }
|
---|
70 | *
|
---|
71 | *
|
---|
72 | * 2) Multithreaded server application
|
---|
73 | *
|
---|
74 | * main()
|
---|
75 | * {
|
---|
76 | * async_manager();
|
---|
77 | * }
|
---|
78 | *
|
---|
79 | * port_handler(ipc_call_t *icall)
|
---|
80 | * {
|
---|
81 | * if (want_refuse) {
|
---|
82 | * async_answer_0(icall, ELIMIT);
|
---|
83 | * return;
|
---|
84 | * }
|
---|
85 | *
|
---|
86 | * async_answer_0(icall, EOK);
|
---|
87 | *
|
---|
88 | * async_get_call(&call);
|
---|
89 | * somehow_handle_the_call(&call);
|
---|
90 | * async_answer_2(&call, 1, 2, 3);
|
---|
91 | *
|
---|
92 | * async_get_call(&call);
|
---|
93 | * ...
|
---|
94 | * }
|
---|
95 | *
|
---|
96 | */
|
---|
97 |
|
---|
98 | #define _LIBC_ASYNC_C_
|
---|
99 | #include <ipc/ipc.h>
|
---|
100 | #include <async.h>
|
---|
101 | #include "../private/async.h"
|
---|
102 | #undef _LIBC_ASYNC_C_
|
---|
103 |
|
---|
104 | #include <ipc/irq.h>
|
---|
105 | #include <ipc/event.h>
|
---|
106 | #include <fibril.h>
|
---|
107 | #include <adt/hash_table.h>
|
---|
108 | #include <adt/hash.h>
|
---|
109 | #include <adt/list.h>
|
---|
110 | #include <assert.h>
|
---|
111 | #include <errno.h>
|
---|
112 | #include <time.h>
|
---|
113 | #include <stdbool.h>
|
---|
114 | #include <stdlib.h>
|
---|
115 | #include <mem.h>
|
---|
116 | #include <stdlib.h>
|
---|
117 | #include <macros.h>
|
---|
118 | #include <str_error.h>
|
---|
119 | #include <as.h>
|
---|
120 | #include <abi/mm/as.h>
|
---|
121 | #include "../private/libc.h"
|
---|
122 | #include "../private/fibril.h"
|
---|
123 |
|
---|
124 | #define DPRINTF(...) ((void) 0)
|
---|
125 |
|
---|
126 | /* Client connection data */
|
---|
127 | typedef struct {
|
---|
128 | ht_link_t link;
|
---|
129 |
|
---|
130 | task_id_t in_task_id;
|
---|
131 | int refcnt;
|
---|
132 | void *data;
|
---|
133 | } client_t;
|
---|
134 |
|
---|
135 | /* Server connection data */
|
---|
136 | typedef struct {
|
---|
137 | /** Fibril handling the connection. */
|
---|
138 | fid_t fid;
|
---|
139 |
|
---|
140 | /** Hash table link. */
|
---|
141 | ht_link_t link;
|
---|
142 |
|
---|
143 | /** Incoming client task ID. */
|
---|
144 | task_id_t in_task_id;
|
---|
145 |
|
---|
146 | /** Link to the client tracking structure. */
|
---|
147 | client_t *client;
|
---|
148 |
|
---|
149 | /** Channel for messages that should be delivered to this fibril. */
|
---|
150 | mpsc_t *msg_channel;
|
---|
151 |
|
---|
152 | /** Call data of the opening call. */
|
---|
153 | ipc_call_t call;
|
---|
154 |
|
---|
155 | /** Fibril function that will be used to handle the connection. */
|
---|
156 | async_port_handler_t handler;
|
---|
157 |
|
---|
158 | /** Client data */
|
---|
159 | void *data;
|
---|
160 | } connection_t;
|
---|
161 |
|
---|
162 | /* Member of notification_t::msg_list. */
|
---|
163 | typedef struct {
|
---|
164 | link_t link;
|
---|
165 | ipc_call_t calldata;
|
---|
166 | } notification_msg_t;
|
---|
167 |
|
---|
168 | /* Notification data */
|
---|
169 | typedef struct {
|
---|
170 | /** notification_hash_table link */
|
---|
171 | ht_link_t htlink;
|
---|
172 |
|
---|
173 | /** notification_queue link */
|
---|
174 | link_t qlink;
|
---|
175 |
|
---|
176 | /** Notification method */
|
---|
177 | sysarg_t imethod;
|
---|
178 |
|
---|
179 | /** Notification handler */
|
---|
180 | async_notification_handler_t handler;
|
---|
181 |
|
---|
182 | /** Notification handler argument */
|
---|
183 | void *arg;
|
---|
184 |
|
---|
185 | /** List of arrived notifications. */
|
---|
186 | list_t msg_list;
|
---|
187 | } notification_t;
|
---|
188 |
|
---|
189 | /** Identifier of the incoming connection handled by the current fibril. */
|
---|
190 | static fibril_local connection_t *fibril_connection;
|
---|
191 |
|
---|
192 | static void *default_client_data_constructor(void)
|
---|
193 | {
|
---|
194 | return NULL;
|
---|
195 | }
|
---|
196 |
|
---|
197 | static void default_client_data_destructor(void *data)
|
---|
198 | {
|
---|
199 | }
|
---|
200 |
|
---|
201 | static async_client_data_ctor_t async_client_data_create =
|
---|
202 | default_client_data_constructor;
|
---|
203 | static async_client_data_dtor_t async_client_data_destroy =
|
---|
204 | default_client_data_destructor;
|
---|
205 |
|
---|
206 | void async_set_client_data_constructor(async_client_data_ctor_t ctor)
|
---|
207 | {
|
---|
208 | assert(async_client_data_create == default_client_data_constructor);
|
---|
209 | async_client_data_create = ctor;
|
---|
210 | }
|
---|
211 |
|
---|
212 | void async_set_client_data_destructor(async_client_data_dtor_t dtor)
|
---|
213 | {
|
---|
214 | assert(async_client_data_destroy == default_client_data_destructor);
|
---|
215 | async_client_data_destroy = dtor;
|
---|
216 | }
|
---|
217 |
|
---|
218 | static async_client_conn_t implicit_connection = NULL;
|
---|
219 | static fibril_rmutex_t client_mutex;
|
---|
220 | static hash_table_t client_hash_table;
|
---|
221 |
|
---|
222 | // TODO: lockfree notification_queue?
|
---|
223 | static fibril_rmutex_t notification_mutex;
|
---|
224 | static hash_table_t notification_hash_table;
|
---|
225 | static LIST_INITIALIZE(notification_queue);
|
---|
226 | static FIBRIL_SEMAPHORE_INITIALIZE(notification_semaphore, 0);
|
---|
227 |
|
---|
228 | static LIST_INITIALIZE(notification_freelist);
|
---|
229 | static long notification_freelist_total = 0;
|
---|
230 | static long notification_freelist_used = 0;
|
---|
231 |
|
---|
232 | static sysarg_t notification_avail = 0;
|
---|
233 |
|
---|
234 | static size_t client_key_hash(const void *key)
|
---|
235 | {
|
---|
236 | const task_id_t *in_task_id = key;
|
---|
237 | return *in_task_id;
|
---|
238 | }
|
---|
239 |
|
---|
240 | static size_t client_hash(const ht_link_t *item)
|
---|
241 | {
|
---|
242 | client_t *client = hash_table_get_inst(item, client_t, link);
|
---|
243 | return client_key_hash(&client->in_task_id);
|
---|
244 | }
|
---|
245 |
|
---|
246 | static bool client_key_equal(const void *key, const ht_link_t *item)
|
---|
247 | {
|
---|
248 | const task_id_t *in_task_id = key;
|
---|
249 | client_t *client = hash_table_get_inst(item, client_t, link);
|
---|
250 | return *in_task_id == client->in_task_id;
|
---|
251 | }
|
---|
252 |
|
---|
253 | /** Operations for the client hash table. */
|
---|
254 | static hash_table_ops_t client_hash_table_ops = {
|
---|
255 | .hash = client_hash,
|
---|
256 | .key_hash = client_key_hash,
|
---|
257 | .key_equal = client_key_equal,
|
---|
258 | .equal = NULL,
|
---|
259 | .remove_callback = NULL
|
---|
260 | };
|
---|
261 |
|
---|
262 | static client_t *async_client_get(task_id_t client_id, bool create)
|
---|
263 | {
|
---|
264 | client_t *client = NULL;
|
---|
265 |
|
---|
266 | fibril_rmutex_lock(&client_mutex);
|
---|
267 | ht_link_t *link = hash_table_find(&client_hash_table, &client_id);
|
---|
268 | if (link) {
|
---|
269 | client = hash_table_get_inst(link, client_t, link);
|
---|
270 | client->refcnt++;
|
---|
271 | } else if (create) {
|
---|
272 | // TODO: move the malloc out of critical section
|
---|
273 | /* malloc() is rmutex safe. */
|
---|
274 | client = malloc(sizeof(client_t));
|
---|
275 | if (client) {
|
---|
276 | client->in_task_id = client_id;
|
---|
277 | client->data = async_client_data_create();
|
---|
278 |
|
---|
279 | client->refcnt = 1;
|
---|
280 | hash_table_insert(&client_hash_table, &client->link);
|
---|
281 | }
|
---|
282 | }
|
---|
283 |
|
---|
284 | fibril_rmutex_unlock(&client_mutex);
|
---|
285 | return client;
|
---|
286 | }
|
---|
287 |
|
---|
288 | static void async_client_put(client_t *client)
|
---|
289 | {
|
---|
290 | bool destroy;
|
---|
291 |
|
---|
292 | fibril_rmutex_lock(&client_mutex);
|
---|
293 |
|
---|
294 | if (--client->refcnt == 0) {
|
---|
295 | hash_table_remove(&client_hash_table, &client->in_task_id);
|
---|
296 | destroy = true;
|
---|
297 | } else
|
---|
298 | destroy = false;
|
---|
299 |
|
---|
300 | fibril_rmutex_unlock(&client_mutex);
|
---|
301 |
|
---|
302 | if (destroy) {
|
---|
303 | if (client->data)
|
---|
304 | async_client_data_destroy(client->data);
|
---|
305 |
|
---|
306 | free(client);
|
---|
307 | }
|
---|
308 | }
|
---|
309 |
|
---|
310 | /** Wrapper for client connection fibril.
|
---|
311 | *
|
---|
312 | * When a new connection arrives, a fibril with this implementing
|
---|
313 | * function is created.
|
---|
314 | *
|
---|
315 | * @param arg Connection structure pointer.
|
---|
316 | *
|
---|
317 | * @return Always zero.
|
---|
318 | *
|
---|
319 | */
|
---|
320 | static errno_t connection_fibril(void *arg)
|
---|
321 | {
|
---|
322 | assert(arg);
|
---|
323 |
|
---|
324 | /*
|
---|
325 | * Setup fibril-local connection pointer.
|
---|
326 | */
|
---|
327 | fibril_connection = (connection_t *) arg;
|
---|
328 |
|
---|
329 | mpsc_t *c = fibril_connection->msg_channel;
|
---|
330 |
|
---|
331 | /*
|
---|
332 | * Add our reference for the current connection in the client task
|
---|
333 | * tracking structure. If this is the first reference, create and
|
---|
334 | * hash in a new tracking structure.
|
---|
335 | */
|
---|
336 |
|
---|
337 | client_t *client = async_client_get(fibril_connection->in_task_id, true);
|
---|
338 | if (!client) {
|
---|
339 | ipc_answer_0(fibril_connection->call.cap_handle, ENOMEM);
|
---|
340 | goto out;
|
---|
341 | }
|
---|
342 |
|
---|
343 | fibril_connection->client = client;
|
---|
344 |
|
---|
345 | /*
|
---|
346 | * Call the connection handler function.
|
---|
347 | */
|
---|
348 | fibril_connection->handler(&fibril_connection->call,
|
---|
349 | fibril_connection->data);
|
---|
350 |
|
---|
351 | /*
|
---|
352 | * Remove the reference for this client task connection.
|
---|
353 | */
|
---|
354 | async_client_put(client);
|
---|
355 |
|
---|
356 | /*
|
---|
357 | * Close the channel, if it isn't closed already.
|
---|
358 | */
|
---|
359 | mpsc_close(c);
|
---|
360 |
|
---|
361 | /*
|
---|
362 | * Answer all remaining messages with EHANGUP.
|
---|
363 | */
|
---|
364 | ipc_call_t call;
|
---|
365 | while (mpsc_receive(c, &call, NULL) == EOK)
|
---|
366 | ipc_answer_0(call.cap_handle, EHANGUP);
|
---|
367 |
|
---|
368 | /*
|
---|
369 | * Clean up memory.
|
---|
370 | */
|
---|
371 | out:
|
---|
372 | mpsc_destroy(c);
|
---|
373 | free(fibril_connection);
|
---|
374 | return EOK;
|
---|
375 | }
|
---|
376 |
|
---|
377 | /** Return label usable during replies to IPC_M_CONNECT_ME_TO. */
|
---|
378 | sysarg_t async_get_label(void)
|
---|
379 | {
|
---|
380 | return (sysarg_t) fibril_connection;
|
---|
381 | }
|
---|
382 |
|
---|
383 | /** Create a new fibril for a new connection.
|
---|
384 | *
|
---|
385 | * Create new fibril for connection, fill in connection structures and insert it
|
---|
386 | * into the hash table, so that later we can easily do routing of messages to
|
---|
387 | * particular fibrils.
|
---|
388 | *
|
---|
389 | * @param conn Pointer to the connection structure. Will be used as the
|
---|
390 | * label of the connected phone and request_label of incoming
|
---|
391 | * calls routed through that phone.
|
---|
392 | * @param in_task_id Identification of the incoming connection.
|
---|
393 | * @param call Call data of the opening call. If call is NULL, the
|
---|
394 | * connection was opened by accepting the
|
---|
395 | * IPC_M_CONNECT_TO_ME call and this function is called
|
---|
396 | * directly by the server.
|
---|
397 | * @param handler Connection handler.
|
---|
398 | * @param data Client argument to pass to the connection handler.
|
---|
399 | *
|
---|
400 | * @return New fibril id or NULL on failure.
|
---|
401 | *
|
---|
402 | */
|
---|
403 | static fid_t async_new_connection(connection_t *conn, task_id_t in_task_id,
|
---|
404 | ipc_call_t *call, async_port_handler_t handler, void *data)
|
---|
405 | {
|
---|
406 | conn->in_task_id = in_task_id;
|
---|
407 | conn->msg_channel = mpsc_create(sizeof(ipc_call_t));
|
---|
408 | conn->handler = handler;
|
---|
409 | conn->data = data;
|
---|
410 |
|
---|
411 | if (!conn->msg_channel)
|
---|
412 | goto error;
|
---|
413 |
|
---|
414 | if (call)
|
---|
415 | conn->call = *call;
|
---|
416 | else
|
---|
417 | conn->call.cap_handle = CAP_NIL;
|
---|
418 |
|
---|
419 | /* We will activate the fibril ASAP */
|
---|
420 | conn->fid = fibril_create(connection_fibril, conn);
|
---|
421 |
|
---|
422 | if (conn->fid == 0)
|
---|
423 | goto error;
|
---|
424 |
|
---|
425 | fibril_start(conn->fid);
|
---|
426 |
|
---|
427 | return conn->fid;
|
---|
428 |
|
---|
429 | error:
|
---|
430 | if (conn->msg_channel)
|
---|
431 | mpsc_destroy(conn->msg_channel);
|
---|
432 | free(conn);
|
---|
433 |
|
---|
434 | if (call)
|
---|
435 | ipc_answer_0(call->cap_handle, ENOMEM);
|
---|
436 |
|
---|
437 | return (fid_t) NULL;
|
---|
438 | }
|
---|
439 |
|
---|
440 | /** Wrapper for making IPC_M_CONNECT_TO_ME calls using the async framework.
|
---|
441 | *
|
---|
442 | * Ask through phone for a new connection to some service.
|
---|
443 | *
|
---|
444 | * @param exch Exchange for sending the message.
|
---|
445 | * @param iface Callback interface.
|
---|
446 | * @param arg1 User defined argument.
|
---|
447 | * @param arg2 User defined argument.
|
---|
448 | * @param handler Callback handler.
|
---|
449 | * @param data Handler data.
|
---|
450 | * @param port_id ID of the newly created port.
|
---|
451 | *
|
---|
452 | * @return Zero on success or an error code.
|
---|
453 | *
|
---|
454 | */
|
---|
455 | errno_t async_create_callback_port(async_exch_t *exch, iface_t iface, sysarg_t arg1,
|
---|
456 | sysarg_t arg2, async_port_handler_t handler, void *data, port_id_t *port_id)
|
---|
457 | {
|
---|
458 | if ((iface & IFACE_MOD_CALLBACK) != IFACE_MOD_CALLBACK)
|
---|
459 | return EINVAL;
|
---|
460 |
|
---|
461 | if (exch == NULL)
|
---|
462 | return ENOENT;
|
---|
463 |
|
---|
464 | connection_t *conn = calloc(1, sizeof(*conn));
|
---|
465 | if (!conn)
|
---|
466 | return ENOMEM;
|
---|
467 |
|
---|
468 | ipc_call_t answer;
|
---|
469 | aid_t req = async_send_5(exch, IPC_M_CONNECT_TO_ME, iface, arg1, arg2,
|
---|
470 | 0, (sysarg_t) conn, &answer);
|
---|
471 |
|
---|
472 | errno_t rc;
|
---|
473 | async_wait_for(req, &rc);
|
---|
474 | if (rc != EOK) {
|
---|
475 | free(conn);
|
---|
476 | return rc;
|
---|
477 | }
|
---|
478 |
|
---|
479 | rc = async_create_port_internal(iface, handler, data, port_id);
|
---|
480 | if (rc != EOK) {
|
---|
481 | free(conn);
|
---|
482 | return rc;
|
---|
483 | }
|
---|
484 |
|
---|
485 | fid_t fid = async_new_connection(conn, answer.task_id, NULL, handler,
|
---|
486 | data);
|
---|
487 | if (fid == (fid_t) NULL)
|
---|
488 | return ENOMEM;
|
---|
489 |
|
---|
490 | return EOK;
|
---|
491 | }
|
---|
492 |
|
---|
493 | static size_t notification_key_hash(const void *key)
|
---|
494 | {
|
---|
495 | const sysarg_t *id = key;
|
---|
496 | return *id;
|
---|
497 | }
|
---|
498 |
|
---|
499 | static size_t notification_hash(const ht_link_t *item)
|
---|
500 | {
|
---|
501 | notification_t *notification =
|
---|
502 | hash_table_get_inst(item, notification_t, htlink);
|
---|
503 | return notification_key_hash(¬ification->imethod);
|
---|
504 | }
|
---|
505 |
|
---|
506 | static bool notification_key_equal(const void *key, const ht_link_t *item)
|
---|
507 | {
|
---|
508 | const sysarg_t *id = key;
|
---|
509 | notification_t *notification =
|
---|
510 | hash_table_get_inst(item, notification_t, htlink);
|
---|
511 | return *id == notification->imethod;
|
---|
512 | }
|
---|
513 |
|
---|
514 | /** Operations for the notification hash table. */
|
---|
515 | static hash_table_ops_t notification_hash_table_ops = {
|
---|
516 | .hash = notification_hash,
|
---|
517 | .key_hash = notification_key_hash,
|
---|
518 | .key_equal = notification_key_equal,
|
---|
519 | .equal = NULL,
|
---|
520 | .remove_callback = NULL
|
---|
521 | };
|
---|
522 |
|
---|
523 | /** Try to route a call to an appropriate connection fibril.
|
---|
524 | *
|
---|
525 | * If the proper connection fibril is found, a message with the call is added to
|
---|
526 | * its message queue. If the fibril was not active, it is activated and all
|
---|
527 | * timeouts are unregistered.
|
---|
528 | *
|
---|
529 | * @param call Data of the incoming call.
|
---|
530 | *
|
---|
531 | * @return EOK if the call was successfully passed to the respective fibril.
|
---|
532 | * @return ENOENT if the call doesn't match any connection.
|
---|
533 | * @return Other error code if routing failed for other reasons.
|
---|
534 | *
|
---|
535 | */
|
---|
536 | static errno_t route_call(ipc_call_t *call)
|
---|
537 | {
|
---|
538 | assert(call);
|
---|
539 |
|
---|
540 | connection_t *conn = (connection_t *) call->request_label;
|
---|
541 |
|
---|
542 | if (!conn)
|
---|
543 | return ENOENT;
|
---|
544 |
|
---|
545 | assert(conn->msg_channel);
|
---|
546 |
|
---|
547 | errno_t rc = mpsc_send(conn->msg_channel, call);
|
---|
548 |
|
---|
549 | if (ipc_get_imethod(call) == IPC_M_PHONE_HUNGUP) {
|
---|
550 | /* Close the channel, but let the connection fibril answer. */
|
---|
551 | mpsc_close(conn->msg_channel);
|
---|
552 | // FIXME: Ideally, we should be able to discard/answer the
|
---|
553 | // hungup message here and just close the channel without
|
---|
554 | // passing it out. Unfortunatelly, somehow that breaks
|
---|
555 | // handling of CPU exceptions.
|
---|
556 | }
|
---|
557 |
|
---|
558 | return rc;
|
---|
559 | }
|
---|
560 |
|
---|
561 | /** Function implementing the notification handler fibril. Never returns. */
|
---|
562 | static errno_t notification_fibril_func(void *arg)
|
---|
563 | {
|
---|
564 | (void) arg;
|
---|
565 |
|
---|
566 | while (true) {
|
---|
567 | fibril_semaphore_down(¬ification_semaphore);
|
---|
568 |
|
---|
569 | fibril_rmutex_lock(¬ification_mutex);
|
---|
570 |
|
---|
571 | /*
|
---|
572 | * The semaphore ensures that if we get this far,
|
---|
573 | * the queue must be non-empty.
|
---|
574 | */
|
---|
575 | assert(!list_empty(¬ification_queue));
|
---|
576 |
|
---|
577 | notification_t *notification = list_get_instance(
|
---|
578 | list_first(¬ification_queue), notification_t, qlink);
|
---|
579 |
|
---|
580 | async_notification_handler_t handler = notification->handler;
|
---|
581 | void *arg = notification->arg;
|
---|
582 |
|
---|
583 | notification_msg_t *m = list_pop(¬ification->msg_list,
|
---|
584 | notification_msg_t, link);
|
---|
585 | assert(m);
|
---|
586 | ipc_call_t calldata = m->calldata;
|
---|
587 |
|
---|
588 | notification_freelist_used--;
|
---|
589 |
|
---|
590 | if (notification_freelist_total > 64 &&
|
---|
591 | notification_freelist_total > 2 * notification_freelist_used) {
|
---|
592 | /* Going to free the structure if we have too much. */
|
---|
593 | notification_freelist_total--;
|
---|
594 | } else {
|
---|
595 | /* Otherwise add to freelist. */
|
---|
596 | list_append(&m->link, ¬ification_freelist);
|
---|
597 | m = NULL;
|
---|
598 | }
|
---|
599 |
|
---|
600 | if (list_empty(¬ification->msg_list))
|
---|
601 | list_remove(¬ification->qlink);
|
---|
602 |
|
---|
603 | fibril_rmutex_unlock(¬ification_mutex);
|
---|
604 |
|
---|
605 | if (handler)
|
---|
606 | handler(&calldata, arg);
|
---|
607 |
|
---|
608 | free(m);
|
---|
609 | }
|
---|
610 |
|
---|
611 | /* Not reached. */
|
---|
612 | return EOK;
|
---|
613 | }
|
---|
614 |
|
---|
615 | /**
|
---|
616 | * Creates a new dedicated fibril for handling notifications.
|
---|
617 | * By default, there is one such fibril. This function can be used to
|
---|
618 | * create more in order to increase the number of notification that can
|
---|
619 | * be processed concurrently.
|
---|
620 | *
|
---|
621 | * Currently, there is no way to destroy those fibrils after they are created.
|
---|
622 | */
|
---|
623 | errno_t async_spawn_notification_handler(void)
|
---|
624 | {
|
---|
625 | fid_t f = fibril_create(notification_fibril_func, NULL);
|
---|
626 | if (f == 0)
|
---|
627 | return ENOMEM;
|
---|
628 |
|
---|
629 | fibril_add_ready(f);
|
---|
630 | return EOK;
|
---|
631 | }
|
---|
632 |
|
---|
633 | /** Queue notification.
|
---|
634 | *
|
---|
635 | * @param call Data of the incoming call.
|
---|
636 | *
|
---|
637 | */
|
---|
638 | static void queue_notification(ipc_call_t *call)
|
---|
639 | {
|
---|
640 | assert(call);
|
---|
641 |
|
---|
642 | fibril_rmutex_lock(¬ification_mutex);
|
---|
643 |
|
---|
644 | notification_msg_t *m = list_pop(¬ification_freelist,
|
---|
645 | notification_msg_t, link);
|
---|
646 |
|
---|
647 | if (!m) {
|
---|
648 | fibril_rmutex_unlock(¬ification_mutex);
|
---|
649 | m = malloc(sizeof(notification_msg_t));
|
---|
650 | if (!m) {
|
---|
651 | DPRINTF("Out of memory.\n");
|
---|
652 | abort();
|
---|
653 | }
|
---|
654 |
|
---|
655 | fibril_rmutex_lock(¬ification_mutex);
|
---|
656 | notification_freelist_total++;
|
---|
657 | }
|
---|
658 |
|
---|
659 | sysarg_t imethod = ipc_get_imethod(call);
|
---|
660 | ht_link_t *link = hash_table_find(¬ification_hash_table, &imethod);
|
---|
661 | if (!link) {
|
---|
662 | /* Invalid notification. */
|
---|
663 | // TODO: Make sure this can't happen and turn it into assert.
|
---|
664 | notification_freelist_total--;
|
---|
665 | fibril_rmutex_unlock(¬ification_mutex);
|
---|
666 | free(m);
|
---|
667 | return;
|
---|
668 | }
|
---|
669 |
|
---|
670 | notification_t *notification =
|
---|
671 | hash_table_get_inst(link, notification_t, htlink);
|
---|
672 |
|
---|
673 | notification_freelist_used++;
|
---|
674 | m->calldata = *call;
|
---|
675 | list_append(&m->link, ¬ification->msg_list);
|
---|
676 |
|
---|
677 | if (!link_in_use(¬ification->qlink))
|
---|
678 | list_append(¬ification->qlink, ¬ification_queue);
|
---|
679 |
|
---|
680 | fibril_rmutex_unlock(¬ification_mutex);
|
---|
681 |
|
---|
682 | fibril_semaphore_up(¬ification_semaphore);
|
---|
683 | }
|
---|
684 |
|
---|
685 | /**
|
---|
686 | * Creates a new notification structure and inserts it into the hash table.
|
---|
687 | *
|
---|
688 | * @param handler Function to call when notification is received.
|
---|
689 | * @param arg Argument for the handler function.
|
---|
690 | * @return The newly created notification structure.
|
---|
691 | */
|
---|
692 | static notification_t *notification_create(async_notification_handler_t handler, void *arg)
|
---|
693 | {
|
---|
694 | notification_t *notification = calloc(1, sizeof(notification_t));
|
---|
695 | if (!notification)
|
---|
696 | return NULL;
|
---|
697 |
|
---|
698 | notification->handler = handler;
|
---|
699 | notification->arg = arg;
|
---|
700 |
|
---|
701 | list_initialize(¬ification->msg_list);
|
---|
702 |
|
---|
703 | fid_t fib = 0;
|
---|
704 |
|
---|
705 | fibril_rmutex_lock(¬ification_mutex);
|
---|
706 |
|
---|
707 | if (notification_avail == 0) {
|
---|
708 | /* Attempt to create the first handler fibril. */
|
---|
709 | fib = fibril_create(notification_fibril_func, NULL);
|
---|
710 | if (fib == 0) {
|
---|
711 | fibril_rmutex_unlock(¬ification_mutex);
|
---|
712 | free(notification);
|
---|
713 | return NULL;
|
---|
714 | }
|
---|
715 | }
|
---|
716 |
|
---|
717 | sysarg_t imethod = notification_avail;
|
---|
718 | notification_avail++;
|
---|
719 |
|
---|
720 | notification->imethod = imethod;
|
---|
721 | hash_table_insert(¬ification_hash_table, ¬ification->htlink);
|
---|
722 |
|
---|
723 | fibril_rmutex_unlock(¬ification_mutex);
|
---|
724 |
|
---|
725 | if (imethod == 0) {
|
---|
726 | assert(fib);
|
---|
727 | fibril_add_ready(fib);
|
---|
728 | }
|
---|
729 |
|
---|
730 | return notification;
|
---|
731 | }
|
---|
732 |
|
---|
733 | /** Subscribe to IRQ notification.
|
---|
734 | *
|
---|
735 | * @param inr IRQ number.
|
---|
736 | * @param handler Notification handler.
|
---|
737 | * @param data Notification handler client data.
|
---|
738 | * @param ucode Top-half pseudocode handler.
|
---|
739 | *
|
---|
740 | * @param[out] handle IRQ capability handle on success.
|
---|
741 | *
|
---|
742 | * @return An error code.
|
---|
743 | *
|
---|
744 | */
|
---|
745 | errno_t async_irq_subscribe(int inr, async_notification_handler_t handler,
|
---|
746 | void *data, const irq_code_t *ucode, cap_irq_handle_t *handle)
|
---|
747 | {
|
---|
748 | notification_t *notification = notification_create(handler, data);
|
---|
749 | if (!notification)
|
---|
750 | return ENOMEM;
|
---|
751 |
|
---|
752 | cap_irq_handle_t ihandle;
|
---|
753 | errno_t rc = ipc_irq_subscribe(inr, notification->imethod, ucode,
|
---|
754 | &ihandle);
|
---|
755 | if (rc == EOK && handle != NULL) {
|
---|
756 | *handle = ihandle;
|
---|
757 | }
|
---|
758 | return rc;
|
---|
759 | }
|
---|
760 |
|
---|
761 | /** Unsubscribe from IRQ notification.
|
---|
762 | *
|
---|
763 | * @param handle IRQ capability handle.
|
---|
764 | *
|
---|
765 | * @return Zero on success or an error code.
|
---|
766 | *
|
---|
767 | */
|
---|
768 | errno_t async_irq_unsubscribe(cap_irq_handle_t ihandle)
|
---|
769 | {
|
---|
770 | // TODO: Remove entry from hash table
|
---|
771 | // to avoid memory leak
|
---|
772 |
|
---|
773 | return ipc_irq_unsubscribe(ihandle);
|
---|
774 | }
|
---|
775 |
|
---|
776 | /** Subscribe to event notifications.
|
---|
777 | *
|
---|
778 | * @param evno Event type to subscribe.
|
---|
779 | * @param handler Notification handler.
|
---|
780 | * @param data Notification handler client data.
|
---|
781 | *
|
---|
782 | * @return Zero on success or an error code.
|
---|
783 | *
|
---|
784 | */
|
---|
785 | errno_t async_event_subscribe(event_type_t evno,
|
---|
786 | async_notification_handler_t handler, void *data)
|
---|
787 | {
|
---|
788 | notification_t *notification = notification_create(handler, data);
|
---|
789 | if (!notification)
|
---|
790 | return ENOMEM;
|
---|
791 |
|
---|
792 | return ipc_event_subscribe(evno, notification->imethod);
|
---|
793 | }
|
---|
794 |
|
---|
795 | /** Subscribe to task event notifications.
|
---|
796 | *
|
---|
797 | * @param evno Event type to subscribe.
|
---|
798 | * @param handler Notification handler.
|
---|
799 | * @param data Notification handler client data.
|
---|
800 | *
|
---|
801 | * @return Zero on success or an error code.
|
---|
802 | *
|
---|
803 | */
|
---|
804 | errno_t async_event_task_subscribe(event_task_type_t evno,
|
---|
805 | async_notification_handler_t handler, void *data)
|
---|
806 | {
|
---|
807 | notification_t *notification = notification_create(handler, data);
|
---|
808 | if (!notification)
|
---|
809 | return ENOMEM;
|
---|
810 |
|
---|
811 | return ipc_event_task_subscribe(evno, notification->imethod);
|
---|
812 | }
|
---|
813 |
|
---|
814 | /** Unmask event notifications.
|
---|
815 | *
|
---|
816 | * @param evno Event type to unmask.
|
---|
817 | *
|
---|
818 | * @return Value returned by the kernel.
|
---|
819 | *
|
---|
820 | */
|
---|
821 | errno_t async_event_unmask(event_type_t evno)
|
---|
822 | {
|
---|
823 | return ipc_event_unmask(evno);
|
---|
824 | }
|
---|
825 |
|
---|
826 | /** Unmask task event notifications.
|
---|
827 | *
|
---|
828 | * @param evno Event type to unmask.
|
---|
829 | *
|
---|
830 | * @return Value returned by the kernel.
|
---|
831 | *
|
---|
832 | */
|
---|
833 | errno_t async_event_task_unmask(event_task_type_t evno)
|
---|
834 | {
|
---|
835 | return ipc_event_task_unmask(evno);
|
---|
836 | }
|
---|
837 |
|
---|
838 | /** Return new incoming message for the current (fibril-local) connection.
|
---|
839 | *
|
---|
840 | * @param call Storage where the incoming call data will be stored.
|
---|
841 | * @param usecs Timeout in microseconds. Zero denotes no timeout.
|
---|
842 | *
|
---|
843 | * @return If no timeout was specified, then true is returned.
|
---|
844 | * @return If a timeout is specified, then true is returned unless
|
---|
845 | * the timeout expires prior to receiving a message.
|
---|
846 | *
|
---|
847 | */
|
---|
848 | bool async_get_call_timeout(ipc_call_t *call, usec_t usecs)
|
---|
849 | {
|
---|
850 | assert(call);
|
---|
851 | assert(fibril_connection);
|
---|
852 |
|
---|
853 | struct timespec ts;
|
---|
854 | struct timespec *expires = NULL;
|
---|
855 | if (usecs) {
|
---|
856 | getuptime(&ts);
|
---|
857 | ts_add_diff(&ts, USEC2NSEC(usecs));
|
---|
858 | expires = &ts;
|
---|
859 | }
|
---|
860 |
|
---|
861 | errno_t rc = mpsc_receive(fibril_connection->msg_channel,
|
---|
862 | call, expires);
|
---|
863 |
|
---|
864 | if (rc == ETIMEOUT)
|
---|
865 | return false;
|
---|
866 |
|
---|
867 | if (rc != EOK) {
|
---|
868 | /*
|
---|
869 | * The async_get_call_timeout() interface doesn't support
|
---|
870 | * propagating errors. Return a null call instead.
|
---|
871 | */
|
---|
872 |
|
---|
873 | memset(call, 0, sizeof(ipc_call_t));
|
---|
874 | ipc_set_imethod(call, IPC_M_PHONE_HUNGUP);
|
---|
875 | call->cap_handle = CAP_NIL;
|
---|
876 | }
|
---|
877 |
|
---|
878 | return true;
|
---|
879 | }
|
---|
880 |
|
---|
881 | bool async_get_call(ipc_call_t *call)
|
---|
882 | {
|
---|
883 | return async_get_call_timeout(call, 0);
|
---|
884 | }
|
---|
885 |
|
---|
886 | void *async_get_client_data(void)
|
---|
887 | {
|
---|
888 | assert(fibril_connection);
|
---|
889 | return fibril_connection->client->data;
|
---|
890 | }
|
---|
891 |
|
---|
892 | void *async_get_client_data_by_id(task_id_t client_id)
|
---|
893 | {
|
---|
894 | client_t *client = async_client_get(client_id, false);
|
---|
895 | if (!client)
|
---|
896 | return NULL;
|
---|
897 |
|
---|
898 | if (!client->data) {
|
---|
899 | async_client_put(client);
|
---|
900 | return NULL;
|
---|
901 | }
|
---|
902 |
|
---|
903 | return client->data;
|
---|
904 | }
|
---|
905 |
|
---|
906 | void async_put_client_data_by_id(task_id_t client_id)
|
---|
907 | {
|
---|
908 | client_t *client = async_client_get(client_id, false);
|
---|
909 |
|
---|
910 | assert(client);
|
---|
911 | assert(client->data);
|
---|
912 |
|
---|
913 | /* Drop the reference we got in async_get_client_data_by_hash(). */
|
---|
914 | async_client_put(client);
|
---|
915 |
|
---|
916 | /* Drop our own reference we got at the beginning of this function. */
|
---|
917 | async_client_put(client);
|
---|
918 | }
|
---|
919 |
|
---|
920 | /** Handle a call that was received.
|
---|
921 | *
|
---|
922 | * If the call has the IPC_M_CONNECT_ME_TO method, a new connection is created.
|
---|
923 | * Otherwise the call is routed to its connection fibril.
|
---|
924 | *
|
---|
925 | * @param call Data of the incoming call.
|
---|
926 | *
|
---|
927 | */
|
---|
928 | static void handle_call(ipc_call_t *call)
|
---|
929 | {
|
---|
930 | assert(call);
|
---|
931 |
|
---|
932 | if (call->flags & IPC_CALL_ANSWERED) {
|
---|
933 | /* Answer to a call made by us. */
|
---|
934 | async_reply_received(call);
|
---|
935 | return;
|
---|
936 | }
|
---|
937 |
|
---|
938 | if (call->cap_handle == CAP_NIL) {
|
---|
939 | if (call->flags & IPC_CALL_NOTIF) {
|
---|
940 | /* Kernel notification */
|
---|
941 | queue_notification(call);
|
---|
942 | }
|
---|
943 | return;
|
---|
944 | }
|
---|
945 |
|
---|
946 | /* New connection */
|
---|
947 | if (ipc_get_imethod(call) == IPC_M_CONNECT_ME_TO) {
|
---|
948 | connection_t *conn = calloc(1, sizeof(*conn));
|
---|
949 | if (!conn) {
|
---|
950 | ipc_answer_0(call->cap_handle, ENOMEM);
|
---|
951 | return;
|
---|
952 | }
|
---|
953 |
|
---|
954 | iface_t iface = (iface_t) ipc_get_arg1(call);
|
---|
955 |
|
---|
956 | // TODO: Currently ignores all ports but the first one.
|
---|
957 | void *data;
|
---|
958 | async_port_handler_t handler =
|
---|
959 | async_get_port_handler(iface, 0, &data);
|
---|
960 |
|
---|
961 | async_new_connection(conn, call->task_id, call, handler, data);
|
---|
962 | return;
|
---|
963 | }
|
---|
964 |
|
---|
965 | /* Route the call according to its request label */
|
---|
966 | errno_t rc = route_call(call);
|
---|
967 | if (rc == EOK) {
|
---|
968 | return;
|
---|
969 | } else if (implicit_connection != NULL) {
|
---|
970 | async_new_connection(call->in_task_id, call->in_phone_hash,
|
---|
971 | callid, call, implicit_connection, NULL);
|
---|
972 | return;
|
---|
973 | }
|
---|
974 |
|
---|
975 | // TODO: Log the error.
|
---|
976 |
|
---|
977 | if (call->cap_handle != CAP_NIL)
|
---|
978 | /* Unknown call from unknown phone - hang it up */
|
---|
979 | ipc_answer_0(call->cap_handle, EHANGUP);
|
---|
980 | }
|
---|
981 |
|
---|
982 | /** Endless loop dispatching incoming calls and answers.
|
---|
983 | *
|
---|
984 | * @return Never returns.
|
---|
985 | *
|
---|
986 | */
|
---|
987 | static errno_t async_manager_worker(void)
|
---|
988 | {
|
---|
989 | ipc_call_t call;
|
---|
990 | errno_t rc;
|
---|
991 |
|
---|
992 | while (true) {
|
---|
993 | rc = fibril_ipc_wait(&call, NULL);
|
---|
994 | if (rc == EOK)
|
---|
995 | handle_call(&call);
|
---|
996 | }
|
---|
997 |
|
---|
998 | return 0;
|
---|
999 | }
|
---|
1000 |
|
---|
1001 | /** Function to start async_manager as a standalone fibril.
|
---|
1002 | *
|
---|
1003 | * When more kernel threads are used, one async manager should exist per thread.
|
---|
1004 | *
|
---|
1005 | * @param arg Unused.
|
---|
1006 | * @return Never returns.
|
---|
1007 | *
|
---|
1008 | */
|
---|
1009 | static errno_t async_manager_fibril(void *arg)
|
---|
1010 | {
|
---|
1011 | async_manager_worker();
|
---|
1012 | return 0;
|
---|
1013 | }
|
---|
1014 |
|
---|
1015 | /** Add one manager to manager list. */
|
---|
1016 | static fid_t async_create_manager(void)
|
---|
1017 | {
|
---|
1018 | fid_t fid = fibril_create_generic(async_manager_fibril, NULL, PAGE_SIZE);
|
---|
1019 | fibril_start(fid);
|
---|
1020 | return fid;
|
---|
1021 | }
|
---|
1022 |
|
---|
1023 | /** Initialize the async framework.
|
---|
1024 | *
|
---|
1025 | */
|
---|
1026 | void __async_server_init(void)
|
---|
1027 | {
|
---|
1028 | if (fibril_rmutex_initialize(&client_mutex) != EOK)
|
---|
1029 | abort();
|
---|
1030 | if (fibril_rmutex_initialize(¬ification_mutex) != EOK)
|
---|
1031 | abort();
|
---|
1032 |
|
---|
1033 | if (!hash_table_create(&client_hash_table, 0, 0, &client_hash_table_ops))
|
---|
1034 | abort();
|
---|
1035 |
|
---|
1036 | if (!hash_table_create(¬ification_hash_table, 0, 0,
|
---|
1037 | ¬ification_hash_table_ops))
|
---|
1038 | abort();
|
---|
1039 |
|
---|
1040 | async_create_manager();
|
---|
1041 | }
|
---|
1042 |
|
---|
1043 | void __async_server_fini(void)
|
---|
1044 | {
|
---|
1045 | fibril_rmutex_destroy(&client_mutex);
|
---|
1046 | fibril_rmutex_destroy(¬ification_mutex);
|
---|
1047 | }
|
---|
1048 |
|
---|
1049 | errno_t async_accept_0(ipc_call_t *call)
|
---|
1050 | {
|
---|
1051 | cap_call_handle_t chandle = call->cap_handle;
|
---|
1052 | assert(chandle != CAP_NIL);
|
---|
1053 | call->cap_handle = CAP_NIL;
|
---|
1054 | return ipc_answer_5(chandle, EOK, 0, 0, 0, 0, async_get_label());
|
---|
1055 | }
|
---|
1056 |
|
---|
1057 | errno_t async_answer_0(ipc_call_t *call, errno_t retval)
|
---|
1058 | {
|
---|
1059 | cap_call_handle_t chandle = call->cap_handle;
|
---|
1060 | assert(chandle != CAP_NIL);
|
---|
1061 | call->cap_handle = CAP_NIL;
|
---|
1062 | return ipc_answer_0(chandle, retval);
|
---|
1063 | }
|
---|
1064 |
|
---|
1065 | errno_t async_answer_1(ipc_call_t *call, errno_t retval, sysarg_t arg1)
|
---|
1066 | {
|
---|
1067 | cap_call_handle_t chandle = call->cap_handle;
|
---|
1068 | assert(chandle != CAP_NIL);
|
---|
1069 | call->cap_handle = CAP_NIL;
|
---|
1070 | return ipc_answer_1(chandle, retval, arg1);
|
---|
1071 | }
|
---|
1072 |
|
---|
1073 | errno_t async_answer_2(ipc_call_t *call, errno_t retval, sysarg_t arg1,
|
---|
1074 | sysarg_t arg2)
|
---|
1075 | {
|
---|
1076 | cap_call_handle_t chandle = call->cap_handle;
|
---|
1077 | assert(chandle != CAP_NIL);
|
---|
1078 | call->cap_handle = CAP_NIL;
|
---|
1079 | return ipc_answer_2(chandle, retval, arg1, arg2);
|
---|
1080 | }
|
---|
1081 |
|
---|
1082 | errno_t async_answer_3(ipc_call_t *call, errno_t retval, sysarg_t arg1,
|
---|
1083 | sysarg_t arg2, sysarg_t arg3)
|
---|
1084 | {
|
---|
1085 | cap_call_handle_t chandle = call->cap_handle;
|
---|
1086 | assert(chandle != CAP_NIL);
|
---|
1087 | call->cap_handle = CAP_NIL;
|
---|
1088 | return ipc_answer_3(chandle, retval, arg1, arg2, arg3);
|
---|
1089 | }
|
---|
1090 |
|
---|
1091 | errno_t async_answer_4(ipc_call_t *call, errno_t retval, sysarg_t arg1,
|
---|
1092 | sysarg_t arg2, sysarg_t arg3, sysarg_t arg4)
|
---|
1093 | {
|
---|
1094 | cap_call_handle_t chandle = call->cap_handle;
|
---|
1095 | assert(chandle != CAP_NIL);
|
---|
1096 | call->cap_handle = CAP_NIL;
|
---|
1097 | return ipc_answer_4(chandle, retval, arg1, arg2, arg3, arg4);
|
---|
1098 | }
|
---|
1099 |
|
---|
1100 | errno_t async_answer_5(ipc_call_t *call, errno_t retval, sysarg_t arg1,
|
---|
1101 | sysarg_t arg2, sysarg_t arg3, sysarg_t arg4, sysarg_t arg5)
|
---|
1102 | {
|
---|
1103 | cap_call_handle_t chandle = call->cap_handle;
|
---|
1104 | assert(chandle != CAP_NIL);
|
---|
1105 | call->cap_handle = CAP_NIL;
|
---|
1106 | return ipc_answer_5(chandle, retval, arg1, arg2, arg3, arg4, arg5);
|
---|
1107 | }
|
---|
1108 |
|
---|
1109 | static errno_t async_forward_fast(ipc_call_t *call, async_exch_t *exch,
|
---|
1110 | sysarg_t imethod, sysarg_t arg1, sysarg_t arg2, unsigned int mode)
|
---|
1111 | {
|
---|
1112 | assert(call);
|
---|
1113 |
|
---|
1114 | cap_call_handle_t chandle = call->cap_handle;
|
---|
1115 | assert(chandle != CAP_NIL);
|
---|
1116 | call->cap_handle = CAP_NIL;
|
---|
1117 |
|
---|
1118 | if (exch == NULL)
|
---|
1119 | return ENOENT;
|
---|
1120 |
|
---|
1121 | return ipc_forward_fast(chandle, exch->phone, imethod, arg1, arg2,
|
---|
1122 | mode);
|
---|
1123 | }
|
---|
1124 |
|
---|
1125 | static errno_t async_forward_slow(ipc_call_t *call, async_exch_t *exch,
|
---|
1126 | sysarg_t imethod, sysarg_t arg1, sysarg_t arg2, sysarg_t arg3,
|
---|
1127 | sysarg_t arg4, sysarg_t arg5, unsigned int mode)
|
---|
1128 | {
|
---|
1129 | assert(call);
|
---|
1130 |
|
---|
1131 | cap_call_handle_t chandle = call->cap_handle;
|
---|
1132 | assert(chandle != CAP_NIL);
|
---|
1133 | call->cap_handle = CAP_NIL;
|
---|
1134 |
|
---|
1135 | if (exch == NULL)
|
---|
1136 | return ENOENT;
|
---|
1137 |
|
---|
1138 | return ipc_forward_slow(chandle, exch->phone, imethod, arg1, arg2, arg3,
|
---|
1139 | arg4, arg5, mode);
|
---|
1140 | }
|
---|
1141 |
|
---|
1142 | errno_t async_forward_0(ipc_call_t *call, async_exch_t *exch, sysarg_t imethod,
|
---|
1143 | unsigned int mode)
|
---|
1144 | {
|
---|
1145 | return async_forward_fast(call, exch, imethod, 0, 0, mode);
|
---|
1146 | }
|
---|
1147 |
|
---|
1148 | errno_t async_forward_1(ipc_call_t *call, async_exch_t *exch, sysarg_t imethod,
|
---|
1149 | sysarg_t arg1, unsigned int mode)
|
---|
1150 | {
|
---|
1151 | return async_forward_fast(call, exch, imethod, arg1, 0, mode);
|
---|
1152 | }
|
---|
1153 |
|
---|
1154 | errno_t async_forward_2(ipc_call_t *call, async_exch_t *exch, sysarg_t imethod,
|
---|
1155 | sysarg_t arg1, sysarg_t arg2, unsigned int mode)
|
---|
1156 | {
|
---|
1157 | return async_forward_fast(call, exch, imethod, arg1, arg2, mode);
|
---|
1158 | }
|
---|
1159 |
|
---|
1160 | errno_t async_forward_3(ipc_call_t *call, async_exch_t *exch, sysarg_t imethod,
|
---|
1161 | sysarg_t arg1, sysarg_t arg2, sysarg_t arg3, unsigned int mode)
|
---|
1162 | {
|
---|
1163 | return async_forward_slow(call, exch, imethod, arg1, arg2, arg3, 0, 0,
|
---|
1164 | mode);
|
---|
1165 | }
|
---|
1166 |
|
---|
1167 | errno_t async_forward_4(ipc_call_t *call, async_exch_t *exch, sysarg_t imethod,
|
---|
1168 | sysarg_t arg1, sysarg_t arg2, sysarg_t arg3, sysarg_t arg4,
|
---|
1169 | unsigned int mode)
|
---|
1170 | {
|
---|
1171 | return async_forward_slow(call, exch, imethod, arg1, arg2, arg3, arg4,
|
---|
1172 | 0, mode);
|
---|
1173 | }
|
---|
1174 |
|
---|
1175 | errno_t async_forward_5(ipc_call_t *call, async_exch_t *exch, sysarg_t imethod,
|
---|
1176 | sysarg_t arg1, sysarg_t arg2, sysarg_t arg3, sysarg_t arg4, sysarg_t arg5,
|
---|
1177 | unsigned int mode)
|
---|
1178 | {
|
---|
1179 | return async_forward_slow(call, exch, imethod, arg1, arg2, arg3, arg4,
|
---|
1180 | arg5, mode);
|
---|
1181 | }
|
---|
1182 |
|
---|
1183 | /** Wrapper for making IPC_M_CONNECT_TO_ME calls using the async framework.
|
---|
1184 | *
|
---|
1185 | * Ask through phone for a new connection to some service.
|
---|
1186 | *
|
---|
1187 | * @param exch Exchange for sending the message.
|
---|
1188 | * @param iface Callback interface.
|
---|
1189 | * @param arg2 User defined argument.
|
---|
1190 | * @param arg3 User defined argument.
|
---|
1191 | *
|
---|
1192 | * @return Zero on success or an error code.
|
---|
1193 | *
|
---|
1194 | */
|
---|
1195 | errno_t async_connect_to_me(async_exch_t *exch, iface_t iface, sysarg_t arg2,
|
---|
1196 | sysarg_t arg3)
|
---|
1197 | {
|
---|
1198 | if (exch == NULL)
|
---|
1199 | return ENOENT;
|
---|
1200 |
|
---|
1201 | sysarg_t label = 0;
|
---|
1202 | errno_t rc = async_req_5_0(exch, IPC_M_CONNECT_TO_ME, iface, arg2, arg3,
|
---|
1203 | 0, label);
|
---|
1204 |
|
---|
1205 | return rc;
|
---|
1206 | }
|
---|
1207 |
|
---|
1208 | /** Wrapper for receiving the IPC_M_SHARE_IN calls using the async framework.
|
---|
1209 | *
|
---|
1210 | * This wrapper only makes it more comfortable to receive IPC_M_SHARE_IN
|
---|
1211 | * calls so that the user doesn't have to remember the meaning of each IPC
|
---|
1212 | * argument.
|
---|
1213 | *
|
---|
1214 | * So far, this wrapper is to be used from within a connection fibril.
|
---|
1215 | *
|
---|
1216 | * @param call Storage for the data of the IPC_M_SHARE_IN call.
|
---|
1217 | * @param size Destination address space area size.
|
---|
1218 | *
|
---|
1219 | * @return True on success, false on failure.
|
---|
1220 | *
|
---|
1221 | */
|
---|
1222 | bool async_share_in_receive(ipc_call_t *call, size_t *size)
|
---|
1223 | {
|
---|
1224 | assert(call);
|
---|
1225 | assert(size);
|
---|
1226 |
|
---|
1227 | async_get_call(call);
|
---|
1228 |
|
---|
1229 | if (ipc_get_imethod(call) != IPC_M_SHARE_IN)
|
---|
1230 | return false;
|
---|
1231 |
|
---|
1232 | *size = (size_t) ipc_get_arg1(call);
|
---|
1233 | return true;
|
---|
1234 | }
|
---|
1235 |
|
---|
1236 | /** Wrapper for answering the IPC_M_SHARE_IN calls using the async framework.
|
---|
1237 | *
|
---|
1238 | * This wrapper only makes it more comfortable to answer IPC_M_SHARE_IN
|
---|
1239 | * calls so that the user doesn't have to remember the meaning of each IPC
|
---|
1240 | * argument.
|
---|
1241 | *
|
---|
1242 | * @param call IPC_M_SHARE_IN call to answer.
|
---|
1243 | * @param src Source address space base.
|
---|
1244 | * @param flags Flags to be used for sharing. Bits can be only cleared.
|
---|
1245 | *
|
---|
1246 | * @return Zero on success or a value from @ref errno.h on failure.
|
---|
1247 | *
|
---|
1248 | */
|
---|
1249 | errno_t async_share_in_finalize(ipc_call_t *call, void *src, unsigned int flags)
|
---|
1250 | {
|
---|
1251 | assert(call);
|
---|
1252 |
|
---|
1253 | cap_call_handle_t chandle = call->cap_handle;
|
---|
1254 | assert(chandle != CAP_NIL);
|
---|
1255 | call->cap_handle = CAP_NIL;
|
---|
1256 |
|
---|
1257 | return ipc_answer_2(chandle, EOK, (sysarg_t) src, (sysarg_t) flags);
|
---|
1258 | }
|
---|
1259 |
|
---|
1260 | /** Wrapper for receiving the IPC_M_SHARE_OUT calls using the async framework.
|
---|
1261 | *
|
---|
1262 | * This wrapper only makes it more comfortable to receive IPC_M_SHARE_OUT
|
---|
1263 | * calls so that the user doesn't have to remember the meaning of each IPC
|
---|
1264 | * argument.
|
---|
1265 | *
|
---|
1266 | * So far, this wrapper is to be used from within a connection fibril.
|
---|
1267 | *
|
---|
1268 | * @param call Storage for the data of the IPC_M_SHARE_OUT call.
|
---|
1269 | * @param size Storage for the source address space area size.
|
---|
1270 | * @param flags Storage for the sharing flags.
|
---|
1271 | *
|
---|
1272 | * @return True on success, false on failure.
|
---|
1273 | *
|
---|
1274 | */
|
---|
1275 | bool async_share_out_receive(ipc_call_t *call, size_t *size,
|
---|
1276 | unsigned int *flags)
|
---|
1277 | {
|
---|
1278 | assert(call);
|
---|
1279 | assert(size);
|
---|
1280 | assert(flags);
|
---|
1281 |
|
---|
1282 | async_get_call(call);
|
---|
1283 |
|
---|
1284 | if (ipc_get_imethod(call) != IPC_M_SHARE_OUT)
|
---|
1285 | return false;
|
---|
1286 |
|
---|
1287 | *size = (size_t) ipc_get_arg2(call);
|
---|
1288 | *flags = (unsigned int) ipc_get_arg3(call);
|
---|
1289 | return true;
|
---|
1290 | }
|
---|
1291 |
|
---|
1292 | /** Wrapper for answering the IPC_M_SHARE_OUT calls using the async framework.
|
---|
1293 | *
|
---|
1294 | * This wrapper only makes it more comfortable to answer IPC_M_SHARE_OUT
|
---|
1295 | * calls so that the user doesn't have to remember the meaning of each IPC
|
---|
1296 | * argument.
|
---|
1297 | *
|
---|
1298 | * @param call IPC_M_SHARE_OUT call to answer.
|
---|
1299 | * @param dst Address of the storage for the destination address space area
|
---|
1300 | * base address.
|
---|
1301 | *
|
---|
1302 | * @return Zero on success or a value from @ref errno.h on failure.
|
---|
1303 | *
|
---|
1304 | */
|
---|
1305 | errno_t async_share_out_finalize(ipc_call_t *call, void **dst)
|
---|
1306 | {
|
---|
1307 | assert(call);
|
---|
1308 |
|
---|
1309 | cap_call_handle_t chandle = call->cap_handle;
|
---|
1310 | assert(chandle != CAP_NIL);
|
---|
1311 | call->cap_handle = CAP_NIL;
|
---|
1312 |
|
---|
1313 | return ipc_answer_2(chandle, EOK, (sysarg_t) __progsymbols.end,
|
---|
1314 | (sysarg_t) dst);
|
---|
1315 | }
|
---|
1316 |
|
---|
1317 | /** Wrapper for receiving the IPC_M_DATA_READ calls using the async framework.
|
---|
1318 | *
|
---|
1319 | * This wrapper only makes it more comfortable to receive IPC_M_DATA_READ
|
---|
1320 | * calls so that the user doesn't have to remember the meaning of each IPC
|
---|
1321 | * argument.
|
---|
1322 | *
|
---|
1323 | * So far, this wrapper is to be used from within a connection fibril.
|
---|
1324 | *
|
---|
1325 | * @param call Storage for the data of the IPC_M_DATA_READ.
|
---|
1326 | * @param size Storage for the maximum size. Can be NULL.
|
---|
1327 | *
|
---|
1328 | * @return True on success, false on failure.
|
---|
1329 | *
|
---|
1330 | */
|
---|
1331 | bool async_data_read_receive(ipc_call_t *call, size_t *size)
|
---|
1332 | {
|
---|
1333 | assert(call);
|
---|
1334 |
|
---|
1335 | async_get_call(call);
|
---|
1336 |
|
---|
1337 | if (ipc_get_imethod(call) != IPC_M_DATA_READ)
|
---|
1338 | return false;
|
---|
1339 |
|
---|
1340 | if (size)
|
---|
1341 | *size = (size_t) ipc_get_arg2(call);
|
---|
1342 |
|
---|
1343 | return true;
|
---|
1344 | }
|
---|
1345 |
|
---|
1346 | /** Wrapper for answering the IPC_M_DATA_READ calls using the async framework.
|
---|
1347 | *
|
---|
1348 | * This wrapper only makes it more comfortable to answer IPC_M_DATA_READ
|
---|
1349 | * calls so that the user doesn't have to remember the meaning of each IPC
|
---|
1350 | * argument.
|
---|
1351 | *
|
---|
1352 | * @param call IPC_M_DATA_READ call to answer.
|
---|
1353 | * @param src Source address for the IPC_M_DATA_READ call.
|
---|
1354 | * @param size Size for the IPC_M_DATA_READ call. Can be smaller than
|
---|
1355 | * the maximum size announced by the sender.
|
---|
1356 | *
|
---|
1357 | * @return Zero on success or a value from @ref errno.h on failure.
|
---|
1358 | *
|
---|
1359 | */
|
---|
1360 | errno_t async_data_read_finalize(ipc_call_t *call, const void *src, size_t size)
|
---|
1361 | {
|
---|
1362 | assert(call);
|
---|
1363 |
|
---|
1364 | cap_call_handle_t chandle = call->cap_handle;
|
---|
1365 | assert(chandle != CAP_NIL);
|
---|
1366 | call->cap_handle = CAP_NIL;
|
---|
1367 |
|
---|
1368 | return ipc_answer_2(chandle, EOK, (sysarg_t) src, (sysarg_t) size);
|
---|
1369 | }
|
---|
1370 |
|
---|
1371 | /** Wrapper for forwarding any read request
|
---|
1372 | *
|
---|
1373 | */
|
---|
1374 | static errno_t async_data_read_forward_fast(async_exch_t *exch, sysarg_t imethod,
|
---|
1375 | sysarg_t arg1, sysarg_t arg2, sysarg_t arg3, sysarg_t arg4,
|
---|
1376 | ipc_call_t *dataptr)
|
---|
1377 | {
|
---|
1378 | if (exch == NULL)
|
---|
1379 | return ENOENT;
|
---|
1380 |
|
---|
1381 | ipc_call_t call;
|
---|
1382 | if (!async_data_read_receive(&call, NULL)) {
|
---|
1383 | async_answer_0(&call, EINVAL);
|
---|
1384 | return EINVAL;
|
---|
1385 | }
|
---|
1386 |
|
---|
1387 | aid_t msg = async_send_4(exch, imethod, arg1, arg2, arg3, arg4,
|
---|
1388 | dataptr);
|
---|
1389 | if (msg == 0) {
|
---|
1390 | async_answer_0(&call, EINVAL);
|
---|
1391 | return EINVAL;
|
---|
1392 | }
|
---|
1393 |
|
---|
1394 | errno_t retval = ipc_forward_fast(call.cap_handle, exch->phone, 0, 0, 0,
|
---|
1395 | IPC_FF_ROUTE_FROM_ME);
|
---|
1396 | if (retval != EOK) {
|
---|
1397 | async_forget(msg);
|
---|
1398 | async_answer_0(&call, retval);
|
---|
1399 | return retval;
|
---|
1400 | }
|
---|
1401 |
|
---|
1402 | errno_t rc;
|
---|
1403 | async_wait_for(msg, &rc);
|
---|
1404 |
|
---|
1405 | return (errno_t) rc;
|
---|
1406 | }
|
---|
1407 |
|
---|
1408 | errno_t async_data_read_forward_0_0(async_exch_t *exch, sysarg_t imethod)
|
---|
1409 | {
|
---|
1410 | return async_data_read_forward_fast(exch, imethod, 0, 0, 0, 0, NULL);
|
---|
1411 | }
|
---|
1412 |
|
---|
1413 | errno_t async_data_read_forward_1_0(async_exch_t *exch, sysarg_t imethod,
|
---|
1414 | sysarg_t arg1)
|
---|
1415 | {
|
---|
1416 | return async_data_read_forward_fast(exch, imethod, arg1, 0, 0, 0, NULL);
|
---|
1417 | }
|
---|
1418 |
|
---|
1419 | errno_t async_data_read_forward_2_0(async_exch_t *exch, sysarg_t imethod,
|
---|
1420 | sysarg_t arg1, sysarg_t arg2)
|
---|
1421 | {
|
---|
1422 | return async_data_read_forward_fast(exch, imethod, arg1, arg2, 0,
|
---|
1423 | 0, NULL);
|
---|
1424 | }
|
---|
1425 |
|
---|
1426 | errno_t async_data_read_forward_3_0(async_exch_t *exch, sysarg_t imethod,
|
---|
1427 | sysarg_t arg1, sysarg_t arg2, sysarg_t arg3)
|
---|
1428 | {
|
---|
1429 | return async_data_read_forward_fast(exch, imethod, arg1, arg2, arg3,
|
---|
1430 | 0, NULL);
|
---|
1431 | }
|
---|
1432 |
|
---|
1433 | errno_t async_data_read_forward_4_0(async_exch_t *exch, sysarg_t imethod,
|
---|
1434 | sysarg_t arg1, sysarg_t arg2, sysarg_t arg3, sysarg_t arg4)
|
---|
1435 | {
|
---|
1436 | return async_data_read_forward_fast(exch, imethod, arg1, arg2, arg3,
|
---|
1437 | arg4, NULL);
|
---|
1438 | }
|
---|
1439 |
|
---|
1440 | errno_t async_data_read_forward_0_1(async_exch_t *exch, sysarg_t imethod,
|
---|
1441 | ipc_call_t *dataptr)
|
---|
1442 | {
|
---|
1443 | return async_data_read_forward_fast(exch, imethod, 0, 0, 0,
|
---|
1444 | 0, dataptr);
|
---|
1445 | }
|
---|
1446 |
|
---|
1447 | errno_t async_data_read_forward_1_1(async_exch_t *exch, sysarg_t imethod,
|
---|
1448 | sysarg_t arg1, ipc_call_t *dataptr)
|
---|
1449 | {
|
---|
1450 | return async_data_read_forward_fast(exch, imethod, arg1, 0, 0,
|
---|
1451 | 0, dataptr);
|
---|
1452 | }
|
---|
1453 |
|
---|
1454 | errno_t async_data_read_forward_2_1(async_exch_t *exch, sysarg_t imethod,
|
---|
1455 | sysarg_t arg1, sysarg_t arg2, ipc_call_t *dataptr)
|
---|
1456 | {
|
---|
1457 | return async_data_read_forward_fast(exch, imethod, arg1, arg2, 0,
|
---|
1458 | 0, dataptr);
|
---|
1459 | }
|
---|
1460 |
|
---|
1461 | errno_t async_data_read_forward_3_1(async_exch_t *exch, sysarg_t imethod,
|
---|
1462 | sysarg_t arg1, sysarg_t arg2, sysarg_t arg3, ipc_call_t *dataptr)
|
---|
1463 | {
|
---|
1464 | return async_data_read_forward_fast(exch, imethod, arg1, arg2, arg3,
|
---|
1465 | 0, dataptr);
|
---|
1466 | }
|
---|
1467 |
|
---|
1468 | errno_t async_data_read_forward_4_1(async_exch_t *exch, sysarg_t imethod,
|
---|
1469 | sysarg_t arg1, sysarg_t arg2, sysarg_t arg3, sysarg_t arg4,
|
---|
1470 | ipc_call_t *dataptr)
|
---|
1471 | {
|
---|
1472 | return async_data_read_forward_fast(exch, imethod, arg1, arg2, arg3,
|
---|
1473 | arg4, dataptr);
|
---|
1474 | }
|
---|
1475 |
|
---|
1476 | /** Wrapper for receiving the IPC_M_DATA_WRITE calls using the async framework.
|
---|
1477 | *
|
---|
1478 | * This wrapper only makes it more comfortable to receive IPC_M_DATA_WRITE
|
---|
1479 | * calls so that the user doesn't have to remember the meaning of each IPC
|
---|
1480 | * argument.
|
---|
1481 | *
|
---|
1482 | * So far, this wrapper is to be used from within a connection fibril.
|
---|
1483 | *
|
---|
1484 | * @param call Storage for the data of the IPC_M_DATA_WRITE.
|
---|
1485 | * @param size Storage for the suggested size. May be NULL.
|
---|
1486 | *
|
---|
1487 | * @return True on success, false on failure.
|
---|
1488 | *
|
---|
1489 | */
|
---|
1490 | bool async_data_write_receive(ipc_call_t *call, size_t *size)
|
---|
1491 | {
|
---|
1492 | assert(call);
|
---|
1493 |
|
---|
1494 | async_get_call(call);
|
---|
1495 |
|
---|
1496 | if (ipc_get_imethod(call) != IPC_M_DATA_WRITE)
|
---|
1497 | return false;
|
---|
1498 |
|
---|
1499 | if (size)
|
---|
1500 | *size = (size_t) ipc_get_arg2(call);
|
---|
1501 |
|
---|
1502 | return true;
|
---|
1503 | }
|
---|
1504 |
|
---|
1505 | /** Wrapper for answering the IPC_M_DATA_WRITE calls using the async framework.
|
---|
1506 | *
|
---|
1507 | * This wrapper only makes it more comfortable to answer IPC_M_DATA_WRITE
|
---|
1508 | * calls so that the user doesn't have to remember the meaning of each IPC
|
---|
1509 | * argument.
|
---|
1510 | *
|
---|
1511 | * @param call IPC_M_DATA_WRITE call to answer.
|
---|
1512 | * @param dst Final destination address for the IPC_M_DATA_WRITE call.
|
---|
1513 | * @param size Final size for the IPC_M_DATA_WRITE call.
|
---|
1514 | *
|
---|
1515 | * @return Zero on success or a value from @ref errno.h on failure.
|
---|
1516 | *
|
---|
1517 | */
|
---|
1518 | errno_t async_data_write_finalize(ipc_call_t *call, void *dst, size_t size)
|
---|
1519 | {
|
---|
1520 | assert(call);
|
---|
1521 |
|
---|
1522 | return async_answer_2(call, EOK, (sysarg_t) dst, (sysarg_t) size);
|
---|
1523 | }
|
---|
1524 |
|
---|
1525 | /** Wrapper for receiving binary data or strings
|
---|
1526 | *
|
---|
1527 | * This wrapper only makes it more comfortable to use async_data_write_*
|
---|
1528 | * functions to receive binary data or strings.
|
---|
1529 | *
|
---|
1530 | * @param data Pointer to data pointer (which should be later disposed
|
---|
1531 | * by free()). If the operation fails, the pointer is not
|
---|
1532 | * touched.
|
---|
1533 | * @param nullterm If true then the received data is always zero terminated.
|
---|
1534 | * This also causes to allocate one extra byte beyond the
|
---|
1535 | * raw transmitted data.
|
---|
1536 | * @param min_size Minimum size (in bytes) of the data to receive.
|
---|
1537 | * @param max_size Maximum size (in bytes) of the data to receive. 0 means
|
---|
1538 | * no limit.
|
---|
1539 | * @param granulariy If non-zero then the size of the received data has to
|
---|
1540 | * be divisible by this value.
|
---|
1541 | * @param received If not NULL, the size of the received data is stored here.
|
---|
1542 | *
|
---|
1543 | * @return Zero on success or a value from @ref errno.h on failure.
|
---|
1544 | *
|
---|
1545 | */
|
---|
1546 | errno_t async_data_write_accept(void **data, const bool nullterm,
|
---|
1547 | const size_t min_size, const size_t max_size, const size_t granularity,
|
---|
1548 | size_t *received)
|
---|
1549 | {
|
---|
1550 | assert(data);
|
---|
1551 |
|
---|
1552 | ipc_call_t call;
|
---|
1553 | size_t size;
|
---|
1554 | if (!async_data_write_receive(&call, &size)) {
|
---|
1555 | async_answer_0(&call, EINVAL);
|
---|
1556 | return EINVAL;
|
---|
1557 | }
|
---|
1558 |
|
---|
1559 | if (size < min_size) {
|
---|
1560 | async_answer_0(&call, EINVAL);
|
---|
1561 | return EINVAL;
|
---|
1562 | }
|
---|
1563 |
|
---|
1564 | if ((max_size > 0) && (size > max_size)) {
|
---|
1565 | async_answer_0(&call, EINVAL);
|
---|
1566 | return EINVAL;
|
---|
1567 | }
|
---|
1568 |
|
---|
1569 | if ((granularity > 0) && ((size % granularity) != 0)) {
|
---|
1570 | async_answer_0(&call, EINVAL);
|
---|
1571 | return EINVAL;
|
---|
1572 | }
|
---|
1573 |
|
---|
1574 | void *arg_data;
|
---|
1575 |
|
---|
1576 | if (nullterm)
|
---|
1577 | arg_data = malloc(size + 1);
|
---|
1578 | else
|
---|
1579 | arg_data = malloc(size);
|
---|
1580 |
|
---|
1581 | if (arg_data == NULL) {
|
---|
1582 | async_answer_0(&call, ENOMEM);
|
---|
1583 | return ENOMEM;
|
---|
1584 | }
|
---|
1585 |
|
---|
1586 | errno_t rc = async_data_write_finalize(&call, arg_data, size);
|
---|
1587 | if (rc != EOK) {
|
---|
1588 | free(arg_data);
|
---|
1589 | return rc;
|
---|
1590 | }
|
---|
1591 |
|
---|
1592 | if (nullterm)
|
---|
1593 | ((char *) arg_data)[size] = 0;
|
---|
1594 |
|
---|
1595 | *data = arg_data;
|
---|
1596 | if (received != NULL)
|
---|
1597 | *received = size;
|
---|
1598 |
|
---|
1599 | return EOK;
|
---|
1600 | }
|
---|
1601 |
|
---|
1602 | /** Wrapper for voiding any data that is about to be received
|
---|
1603 | *
|
---|
1604 | * This wrapper can be used to void any pending data
|
---|
1605 | *
|
---|
1606 | * @param retval Error value from @ref errno.h to be returned to the caller.
|
---|
1607 | *
|
---|
1608 | */
|
---|
1609 | void async_data_write_void(errno_t retval)
|
---|
1610 | {
|
---|
1611 | ipc_call_t call;
|
---|
1612 | async_data_write_receive(&call, NULL);
|
---|
1613 | async_answer_0(&call, retval);
|
---|
1614 | }
|
---|
1615 |
|
---|
1616 | /** Wrapper for forwarding any data that is about to be received
|
---|
1617 | *
|
---|
1618 | */
|
---|
1619 | static errno_t async_data_write_forward_fast(async_exch_t *exch,
|
---|
1620 | sysarg_t imethod, sysarg_t arg1, sysarg_t arg2, sysarg_t arg3,
|
---|
1621 | sysarg_t arg4, ipc_call_t *dataptr)
|
---|
1622 | {
|
---|
1623 | if (exch == NULL)
|
---|
1624 | return ENOENT;
|
---|
1625 |
|
---|
1626 | ipc_call_t call;
|
---|
1627 | if (!async_data_write_receive(&call, NULL)) {
|
---|
1628 | async_answer_0(&call, EINVAL);
|
---|
1629 | return EINVAL;
|
---|
1630 | }
|
---|
1631 |
|
---|
1632 | aid_t msg = async_send_4(exch, imethod, arg1, arg2, arg3, arg4,
|
---|
1633 | dataptr);
|
---|
1634 | if (msg == 0) {
|
---|
1635 | async_answer_0(&call, EINVAL);
|
---|
1636 | return EINVAL;
|
---|
1637 | }
|
---|
1638 |
|
---|
1639 | errno_t retval = ipc_forward_fast(call.cap_handle, exch->phone, 0, 0, 0,
|
---|
1640 | IPC_FF_ROUTE_FROM_ME);
|
---|
1641 | if (retval != EOK) {
|
---|
1642 | async_forget(msg);
|
---|
1643 | async_answer_0(&call, retval);
|
---|
1644 | return retval;
|
---|
1645 | }
|
---|
1646 |
|
---|
1647 | errno_t rc;
|
---|
1648 | async_wait_for(msg, &rc);
|
---|
1649 |
|
---|
1650 | return (errno_t) rc;
|
---|
1651 | }
|
---|
1652 |
|
---|
1653 | errno_t async_data_write_forward_0_0(async_exch_t *exch, sysarg_t imethod)
|
---|
1654 | {
|
---|
1655 | return async_data_write_forward_fast(exch, imethod, 0, 0, 0,
|
---|
1656 | 0, NULL);
|
---|
1657 | }
|
---|
1658 |
|
---|
1659 | errno_t async_data_write_forward_1_0(async_exch_t *exch, sysarg_t imethod,
|
---|
1660 | sysarg_t arg1)
|
---|
1661 | {
|
---|
1662 | return async_data_write_forward_fast(exch, imethod, arg1, 0, 0,
|
---|
1663 | 0, NULL);
|
---|
1664 | }
|
---|
1665 |
|
---|
1666 | errno_t async_data_write_forward_2_0(async_exch_t *exch, sysarg_t imethod,
|
---|
1667 | sysarg_t arg1, sysarg_t arg2)
|
---|
1668 | {
|
---|
1669 | return async_data_write_forward_fast(exch, imethod, arg1, arg2, 0,
|
---|
1670 | 0, NULL);
|
---|
1671 | }
|
---|
1672 |
|
---|
1673 | errno_t async_data_write_forward_3_0(async_exch_t *exch, sysarg_t imethod,
|
---|
1674 | sysarg_t arg1, sysarg_t arg2, sysarg_t arg3)
|
---|
1675 | {
|
---|
1676 | return async_data_write_forward_fast(exch, imethod, arg1, arg2, arg3,
|
---|
1677 | 0, NULL);
|
---|
1678 | }
|
---|
1679 |
|
---|
1680 | errno_t async_data_write_forward_4_0(async_exch_t *exch, sysarg_t imethod,
|
---|
1681 | sysarg_t arg1, sysarg_t arg2, sysarg_t arg3, sysarg_t arg4)
|
---|
1682 | {
|
---|
1683 | return async_data_write_forward_fast(exch, imethod, arg1, arg2, arg3,
|
---|
1684 | arg4, NULL);
|
---|
1685 | }
|
---|
1686 |
|
---|
1687 | errno_t async_data_write_forward_0_1(async_exch_t *exch, sysarg_t imethod,
|
---|
1688 | ipc_call_t *dataptr)
|
---|
1689 | {
|
---|
1690 | return async_data_write_forward_fast(exch, imethod, 0, 0, 0,
|
---|
1691 | 0, dataptr);
|
---|
1692 | }
|
---|
1693 |
|
---|
1694 | errno_t async_data_write_forward_1_1(async_exch_t *exch, sysarg_t imethod,
|
---|
1695 | sysarg_t arg1, ipc_call_t *dataptr)
|
---|
1696 | {
|
---|
1697 | return async_data_write_forward_fast(exch, imethod, arg1, 0, 0,
|
---|
1698 | 0, dataptr);
|
---|
1699 | }
|
---|
1700 |
|
---|
1701 | errno_t async_data_write_forward_2_1(async_exch_t *exch, sysarg_t imethod,
|
---|
1702 | sysarg_t arg1, sysarg_t arg2, ipc_call_t *dataptr)
|
---|
1703 | {
|
---|
1704 | return async_data_write_forward_fast(exch, imethod, arg1, arg2, 0,
|
---|
1705 | 0, dataptr);
|
---|
1706 | }
|
---|
1707 |
|
---|
1708 | errno_t async_data_write_forward_3_1(async_exch_t *exch, sysarg_t imethod,
|
---|
1709 | sysarg_t arg1, sysarg_t arg2, sysarg_t arg3, ipc_call_t *dataptr)
|
---|
1710 | {
|
---|
1711 | return async_data_write_forward_fast(exch, imethod, arg1, arg2, arg3,
|
---|
1712 | 0, dataptr);
|
---|
1713 | }
|
---|
1714 |
|
---|
1715 | errno_t async_data_write_forward_4_1(async_exch_t *exch, sysarg_t imethod,
|
---|
1716 | sysarg_t arg1, sysarg_t arg2, sysarg_t arg3, sysarg_t arg4,
|
---|
1717 | ipc_call_t *dataptr)
|
---|
1718 | {
|
---|
1719 | return async_data_write_forward_fast(exch, imethod, arg1, arg2, arg3,
|
---|
1720 | arg4, dataptr);
|
---|
1721 | }
|
---|
1722 |
|
---|
1723 | /** Wrapper for receiving the IPC_M_CONNECT_TO_ME calls.
|
---|
1724 | *
|
---|
1725 | * If the current call is IPC_M_CONNECT_TO_ME then a new
|
---|
1726 | * async session is created for the accepted phone.
|
---|
1727 | *
|
---|
1728 | * @param mgmt Exchange management style.
|
---|
1729 | *
|
---|
1730 | * @return New async session.
|
---|
1731 | * @return NULL on failure.
|
---|
1732 | *
|
---|
1733 | */
|
---|
1734 | async_sess_t *async_callback_receive(exch_mgmt_t mgmt)
|
---|
1735 | {
|
---|
1736 | /* Accept the phone */
|
---|
1737 | ipc_call_t call;
|
---|
1738 | async_get_call(&call);
|
---|
1739 |
|
---|
1740 | cap_phone_handle_t phandle = (cap_handle_t) ipc_get_arg5(&call);
|
---|
1741 |
|
---|
1742 | if ((ipc_get_imethod(&call) != IPC_M_CONNECT_TO_ME) ||
|
---|
1743 | !cap_handle_valid((phandle))) {
|
---|
1744 | async_answer_0(&call, EINVAL);
|
---|
1745 | return NULL;
|
---|
1746 | }
|
---|
1747 |
|
---|
1748 | async_sess_t *sess = calloc(1, sizeof(async_sess_t));
|
---|
1749 | if (sess == NULL) {
|
---|
1750 | async_answer_0(&call, ENOMEM);
|
---|
1751 | return NULL;
|
---|
1752 | }
|
---|
1753 |
|
---|
1754 | sess->iface = 0;
|
---|
1755 | sess->mgmt = mgmt;
|
---|
1756 | sess->phone = phandle;
|
---|
1757 |
|
---|
1758 | fibril_mutex_initialize(&sess->remote_state_mtx);
|
---|
1759 | list_initialize(&sess->exch_list);
|
---|
1760 | fibril_mutex_initialize(&sess->mutex);
|
---|
1761 |
|
---|
1762 | /* Acknowledge the connected phone */
|
---|
1763 | async_answer_0(&call, EOK);
|
---|
1764 |
|
---|
1765 | return sess;
|
---|
1766 | }
|
---|
1767 |
|
---|
1768 | /** Wrapper for receiving the IPC_M_CONNECT_TO_ME calls.
|
---|
1769 | *
|
---|
1770 | * If the call is IPC_M_CONNECT_TO_ME then a new
|
---|
1771 | * async session is created. However, the phone is
|
---|
1772 | * not accepted automatically.
|
---|
1773 | *
|
---|
1774 | * @param mgmt Exchange management style.
|
---|
1775 | * @param call Call data.
|
---|
1776 | *
|
---|
1777 | * @return New async session.
|
---|
1778 | * @return NULL on failure.
|
---|
1779 | * @return NULL if the call is not IPC_M_CONNECT_TO_ME.
|
---|
1780 | *
|
---|
1781 | */
|
---|
1782 | async_sess_t *async_callback_receive_start(exch_mgmt_t mgmt, ipc_call_t *call)
|
---|
1783 | {
|
---|
1784 | cap_phone_handle_t phandle = (cap_handle_t) ipc_get_arg5(call);
|
---|
1785 |
|
---|
1786 | if ((ipc_get_imethod(call) != IPC_M_CONNECT_TO_ME) ||
|
---|
1787 | !cap_handle_valid((phandle)))
|
---|
1788 | return NULL;
|
---|
1789 |
|
---|
1790 | async_sess_t *sess = calloc(1, sizeof(async_sess_t));
|
---|
1791 | if (sess == NULL)
|
---|
1792 | return NULL;
|
---|
1793 |
|
---|
1794 | sess->iface = 0;
|
---|
1795 | sess->mgmt = mgmt;
|
---|
1796 | sess->phone = phandle;
|
---|
1797 |
|
---|
1798 | fibril_mutex_initialize(&sess->remote_state_mtx);
|
---|
1799 | list_initialize(&sess->exch_list);
|
---|
1800 | fibril_mutex_initialize(&sess->mutex);
|
---|
1801 |
|
---|
1802 | return sess;
|
---|
1803 | }
|
---|
1804 |
|
---|
1805 | bool async_state_change_receive(ipc_call_t *call)
|
---|
1806 | {
|
---|
1807 | assert(call);
|
---|
1808 |
|
---|
1809 | async_get_call(call);
|
---|
1810 |
|
---|
1811 | if (ipc_get_imethod(call) != IPC_M_STATE_CHANGE_AUTHORIZE)
|
---|
1812 | return false;
|
---|
1813 |
|
---|
1814 | return true;
|
---|
1815 | }
|
---|
1816 |
|
---|
1817 | errno_t async_state_change_finalize(ipc_call_t *call, async_exch_t *other_exch)
|
---|
1818 | {
|
---|
1819 | assert(call);
|
---|
1820 |
|
---|
1821 | return async_answer_1(call, EOK, cap_handle_raw(other_exch->phone));
|
---|
1822 | }
|
---|
1823 |
|
---|
1824 | __noreturn void async_manager(void)
|
---|
1825 | {
|
---|
1826 | fibril_event_t ever = FIBRIL_EVENT_INIT;
|
---|
1827 | fibril_wait_for(&ever);
|
---|
1828 | __builtin_unreachable();
|
---|
1829 | }
|
---|
1830 |
|
---|
1831 | /** @}
|
---|
1832 | */
|
---|