Rev 2805 | Rev 2808 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 1027 | palkovsky | 1 | /* |
| 2071 | jermar | 2 | * Copyright (c) 2006 Ondrej Palkovsky |
| 1027 | 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 | |||
| 1757 | jermar | 29 | /** @addtogroup genericipc |
| 1702 | cejka | 30 | * @{ |
| 31 | */ |
||
| 32 | /** @file |
||
| 33 | */ |
||
| 34 | |||
| 1027 | palkovsky | 35 | #include <arch.h> |
| 36 | #include <proc/task.h> |
||
| 1288 | jermar | 37 | #include <proc/thread.h> |
| 1027 | palkovsky | 38 | #include <errno.h> |
| 39 | #include <memstr.h> |
||
| 40 | #include <debug.h> |
||
| 41 | #include <ipc/ipc.h> |
||
| 42 | #include <ipc/sysipc.h> |
||
| 1281 | palkovsky | 43 | #include <ipc/irq.h> |
| 1072 | palkovsky | 44 | #include <ipc/ipcrsc.h> |
| 1258 | palkovsky | 45 | #include <arch/interrupt.h> |
| 1027 | palkovsky | 46 | #include <print.h> |
| 1288 | jermar | 47 | #include <syscall/copy.h> |
| 1297 | jermar | 48 | #include <security/cap.h> |
| 1329 | palkovsky | 49 | #include <mm/as.h> |
| 1875 | jermar | 50 | #include <print.h> |
| 1027 | palkovsky | 51 | |
| 2660 | jermar | 52 | /** |
| 53 | * Maximum buffer size allowed for IPC_M_DATA_WRITE and IPC_M_DATA_READ |
||
| 54 | * requests. |
||
| 55 | */ |
||
| 56 | #define DATA_XFER_LIMIT (64 * 1024) |
||
| 2494 | jermar | 57 | |
| 2471 | jermar | 58 | #define GET_CHECK_PHONE(phone, phoneid, err) \ |
| 59 | { \ |
||
| 60 | if (phoneid > IPC_MAX_PHONES) { \ |
||
| 61 | err; \ |
||
| 62 | } \ |
||
| 63 | phone = &TASK->phones[phoneid]; \ |
||
| 1084 | palkovsky | 64 | } |
| 65 | |||
| 2471 | jermar | 66 | #define STRUCT_TO_USPACE(dst, src) copy_to_uspace(dst, src, sizeof(*(src))) |
| 1084 | palkovsky | 67 | |
| 2471 | jermar | 68 | /** Decide if the method is a system method. |
| 69 | * |
||
| 70 | * @param method Method to be decided. |
||
| 71 | * |
||
| 72 | * @return Return 1 if the method is a system method. |
||
| 73 | * Otherwise return 0. |
||
| 74 | */ |
||
| 2557 | jermar | 75 | static inline int method_is_system(unative_t method) |
| 1040 | palkovsky | 76 | { |
| 77 | if (method <= IPC_M_LAST_SYSTEM) |
||
| 78 | return 1; |
||
| 79 | return 0; |
||
| 80 | } |
||
| 81 | |||
| 2471 | jermar | 82 | /** Decide if the message with this method is forwardable. |
| 1040 | palkovsky | 83 | * |
| 84 | * - some system messages may be forwarded, for some of them |
||
| 85 | * it is useless |
||
| 2471 | jermar | 86 | * |
| 87 | * @param method Method to be decided. |
||
| 88 | * |
||
| 89 | * @return Return 1 if the method is forwardable. |
||
| 90 | * Otherwise return 0. |
||
| 1040 | palkovsky | 91 | */ |
| 2557 | jermar | 92 | static inline int method_is_forwardable(unative_t method) |
| 1040 | palkovsky | 93 | { |
| 2494 | jermar | 94 | switch (method) { |
| 95 | case IPC_M_PHONE_HUNGUP: |
||
| 96 | /* This message is meant only for the original recipient. */ |
||
| 97 | return 0; |
||
| 98 | default: |
||
| 99 | return 1; |
||
| 100 | } |
||
| 1040 | palkovsky | 101 | } |
| 102 | |||
| 2557 | jermar | 103 | /** Decide if the message with this method is immutable on forward. |
| 104 | * |
||
| 2601 | jermar | 105 | * - some system messages may be forwarded but their content cannot be altered |
| 2557 | jermar | 106 | * |
| 107 | * @param method Method to be decided. |
||
| 108 | * |
||
| 109 | * @return Return 1 if the method is immutable on forward. |
||
| 110 | * Otherwise return 0. |
||
| 111 | */ |
||
| 112 | static inline int method_is_immutable(unative_t method) |
||
| 113 | { |
||
| 114 | switch (method) { |
||
| 2677 | jermar | 115 | case IPC_M_SHARE_OUT: |
| 116 | case IPC_M_SHARE_IN: |
||
| 2660 | jermar | 117 | case IPC_M_DATA_WRITE: |
| 118 | case IPC_M_DATA_READ: |
||
| 2557 | jermar | 119 | return 1; |
| 120 | break; |
||
| 121 | default: |
||
| 122 | return 0; |
||
| 123 | } |
||
| 124 | } |
||
| 1027 | palkovsky | 125 | |
| 2557 | jermar | 126 | |
| 2471 | jermar | 127 | /*********************************************************************** |
| 128 | * Functions that preprocess answer before sending it to the recepient. |
||
| 129 | ***********************************************************************/ |
||
| 130 | |||
| 131 | /** Decide if the caller (e.g. ipc_answer()) should save the old call contents |
||
| 132 | * for answer_preprocess(). |
||
| 133 | * |
||
| 134 | * @param call Call structure to be decided. |
||
| 135 | * |
||
| 136 | * @return Return 1 if the old call contents should be saved. |
||
| 137 | * Return 0 otherwise. |
||
| 1027 | palkovsky | 138 | */ |
| 1088 | palkovsky | 139 | static inline int answer_need_old(call_t *call) |
| 1027 | palkovsky | 140 | { |
| 2494 | jermar | 141 | switch (IPC_GET_METHOD(call->data)) { |
| 142 | case IPC_M_CONNECT_TO_ME: |
||
| 143 | case IPC_M_CONNECT_ME_TO: |
||
| 2677 | jermar | 144 | case IPC_M_SHARE_OUT: |
| 145 | case IPC_M_SHARE_IN: |
||
| 2660 | jermar | 146 | case IPC_M_DATA_WRITE: |
| 147 | case IPC_M_DATA_READ: |
||
| 1027 | palkovsky | 148 | return 1; |
| 2494 | jermar | 149 | default: |
| 150 | return 0; |
||
| 151 | } |
||
| 1027 | palkovsky | 152 | } |
| 153 | |||
| 2471 | jermar | 154 | /** Interpret process answer as control information. |
| 1428 | palkovsky | 155 | * |
| 2471 | jermar | 156 | * This function is called directly after sys_ipc_answer(). |
| 157 | * |
||
| 158 | * @param answer Call structure with the answer. |
||
| 159 | * @param olddata Saved data of the request. |
||
| 160 | * |
||
| 161 | * @return Return 0 on success or an error code. |
||
| 1428 | palkovsky | 162 | */ |
| 1329 | palkovsky | 163 | static inline int answer_preprocess(call_t *answer, ipc_data_t *olddata) |
| 1027 | palkovsky | 164 | { |
| 165 | int phoneid; |
||
| 166 | |||
| 2745 | decky | 167 | if ((native_t) IPC_GET_RETVAL(answer->data) == EHANGUP) { |
| 1141 | palkovsky | 168 | /* In case of forward, hangup the forwared phone, |
| 169 | * not the originator |
||
| 170 | */ |
||
| 171 | spinlock_lock(&answer->data.phone->lock); |
||
| 172 | spinlock_lock(&TASK->answerbox.lock); |
||
| 1568 | palkovsky | 173 | if (answer->data.phone->state == IPC_PHONE_CONNECTED) { |
| 1573 | palkovsky | 174 | list_remove(&answer->data.phone->link); |
| 1568 | palkovsky | 175 | answer->data.phone->state = IPC_PHONE_SLAMMED; |
| 1141 | palkovsky | 176 | } |
| 177 | spinlock_unlock(&TASK->answerbox.lock); |
||
| 178 | spinlock_unlock(&answer->data.phone->lock); |
||
| 1088 | palkovsky | 179 | } |
| 180 | |||
| 181 | if (!olddata) |
||
| 1329 | palkovsky | 182 | return 0; |
| 1088 | palkovsky | 183 | |
| 1086 | palkovsky | 184 | if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_TO_ME) { |
| 2637 | cejka | 185 | phoneid = IPC_GET_ARG5(*olddata); |
| 1027 | palkovsky | 186 | if (IPC_GET_RETVAL(answer->data)) { |
| 187 | /* The connection was not accepted */ |
||
| 188 | phone_dealloc(phoneid); |
||
| 1040 | palkovsky | 189 | } else { |
| 1090 | palkovsky | 190 | /* The connection was accepted */ |
| 2359 | jermar | 191 | phone_connect(phoneid, &answer->sender->answerbox); |
| 2638 | jermar | 192 | /* Set 'phone hash' as arg5 of response */ |
| 2637 | cejka | 193 | IPC_SET_ARG5(answer->data, |
| 2359 | jermar | 194 | (unative_t) &TASK->phones[phoneid]); |
| 1027 | palkovsky | 195 | } |
| 1086 | palkovsky | 196 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_ME_TO) { |
| 1060 | palkovsky | 197 | /* If the users accepted call, connect */ |
| 198 | if (!IPC_GET_RETVAL(answer->data)) { |
||
| 2635 | cejka | 199 | ipc_phone_connect((phone_t *) IPC_GET_ARG5(*olddata), |
| 2359 | jermar | 200 | &TASK->answerbox); |
| 1060 | palkovsky | 201 | } |
| 2677 | jermar | 202 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_SHARE_OUT) { |
| 2359 | jermar | 203 | if (!IPC_GET_RETVAL(answer->data)) { |
| 204 | /* Accepted, handle as_area receipt */ |
||
| 1413 | jermar | 205 | ipl_t ipl; |
| 1461 | palkovsky | 206 | int rc; |
| 1413 | jermar | 207 | as_t *as; |
| 208 | |||
| 209 | ipl = interrupts_disable(); |
||
| 210 | spinlock_lock(&answer->sender->lock); |
||
| 211 | as = answer->sender->as; |
||
| 212 | spinlock_unlock(&answer->sender->lock); |
||
| 213 | interrupts_restore(ipl); |
||
| 214 | |||
| 2359 | jermar | 215 | rc = as_area_share(as, IPC_GET_ARG1(*olddata), |
| 216 | IPC_GET_ARG2(*olddata), AS, |
||
| 217 | IPC_GET_ARG1(answer->data), IPC_GET_ARG3(*olddata)); |
||
| 1461 | palkovsky | 218 | IPC_SET_RETVAL(answer->data, rc); |
| 219 | return rc; |
||
| 1329 | palkovsky | 220 | } |
| 2677 | jermar | 221 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_SHARE_IN) { |
| 1428 | palkovsky | 222 | if (!IPC_GET_RETVAL(answer->data)) { |
| 223 | ipl_t ipl; |
||
| 224 | as_t *as; |
||
| 1434 | palkovsky | 225 | int rc; |
| 1428 | palkovsky | 226 | |
| 227 | ipl = interrupts_disable(); |
||
| 228 | spinlock_lock(&answer->sender->lock); |
||
| 229 | as = answer->sender->as; |
||
| 230 | spinlock_unlock(&answer->sender->lock); |
||
| 231 | interrupts_restore(ipl); |
||
| 232 | |||
| 2359 | jermar | 233 | rc = as_area_share(AS, IPC_GET_ARG1(answer->data), |
| 234 | IPC_GET_ARG2(*olddata), as, IPC_GET_ARG1(*olddata), |
||
| 235 | IPC_GET_ARG2(answer->data)); |
||
| 1434 | palkovsky | 236 | IPC_SET_RETVAL(answer->data, rc); |
| 1428 | palkovsky | 237 | } |
| 2662 | jermar | 238 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_DATA_READ) { |
| 239 | ASSERT(!answer->buffer); |
||
| 240 | if (!IPC_GET_RETVAL(answer->data)) { |
||
| 241 | /* The recipient agreed to send data. */ |
||
| 242 | uintptr_t src = IPC_GET_ARG1(answer->data); |
||
| 243 | uintptr_t dst = IPC_GET_ARG1(*olddata); |
||
| 244 | size_t max_size = IPC_GET_ARG2(*olddata); |
||
| 245 | size_t size = IPC_GET_ARG2(answer->data); |
||
| 246 | if (size <= max_size) { |
||
| 247 | /* |
||
| 248 | * Copy the destination VA so that this piece of |
||
| 249 | * information is not lost. |
||
| 250 | */ |
||
| 251 | IPC_SET_ARG1(answer->data, dst); |
||
| 252 | |||
| 253 | answer->buffer = malloc(size, 0); |
||
| 254 | int rc = copy_from_uspace(answer->buffer, |
||
| 255 | (void *) src, size); |
||
| 256 | if (rc) { |
||
| 257 | IPC_SET_RETVAL(answer->data, rc); |
||
| 258 | free(answer->buffer); |
||
| 259 | answer->buffer = NULL; |
||
| 260 | } |
||
| 261 | } else { |
||
| 262 | IPC_SET_RETVAL(answer->data, ELIMIT); |
||
| 263 | } |
||
| 264 | } |
||
| 2660 | jermar | 265 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_DATA_WRITE) { |
| 2661 | jermar | 266 | ASSERT(answer->buffer); |
| 2494 | jermar | 267 | if (!IPC_GET_RETVAL(answer->data)) { |
| 2662 | jermar | 268 | /* The recipient agreed to receive data. */ |
| 2494 | jermar | 269 | int rc; |
| 270 | uintptr_t dst; |
||
| 271 | uintptr_t size; |
||
| 2662 | jermar | 272 | uintptr_t max_size; |
| 2494 | jermar | 273 | |
| 274 | dst = IPC_GET_ARG1(answer->data); |
||
| 2676 | jermar | 275 | size = IPC_GET_ARG2(answer->data); |
| 276 | max_size = IPC_GET_ARG2(*olddata); |
||
| 2494 | jermar | 277 | |
| 2662 | jermar | 278 | if (size <= max_size) { |
| 279 | rc = copy_to_uspace((void *) dst, |
||
| 280 | answer->buffer, size); |
||
| 281 | if (rc) |
||
| 282 | IPC_SET_RETVAL(answer->data, rc); |
||
| 283 | } else { |
||
| 284 | IPC_SET_RETVAL(answer->data, ELIMIT); |
||
| 285 | } |
||
| 2494 | jermar | 286 | } |
| 2661 | jermar | 287 | free(answer->buffer); |
| 288 | answer->buffer = NULL; |
||
| 1027 | palkovsky | 289 | } |
| 1329 | palkovsky | 290 | return 0; |
| 1027 | palkovsky | 291 | } |
| 292 | |||
| 2801 | svoboda | 293 | static task_t *get_lock_callee_task(phone_t *phone) |
| 294 | { |
||
| 295 | answerbox_t *answerbox; |
||
| 296 | task_t *ta; |
||
| 297 | |||
| 298 | // FIXME: locking!!! |
||
| 299 | |||
| 300 | answerbox = phone->callee; |
||
| 301 | ta = answerbox->task; |
||
| 302 | |||
| 303 | spinlock_lock(&ta->lock); |
||
| 304 | |||
| 305 | return ta; |
||
| 306 | } |
||
| 307 | |||
| 2807 | svoboda | 308 | static thread_t *get_task_thread_by_id(task_t *ta, thread_id_t tid) |
| 309 | { |
||
| 310 | thread_t *t; |
||
| 311 | link_t *cur; |
||
| 312 | |||
| 313 | for (cur = ta->th_head.next; cur != &ta->th_head; cur = cur->next) { |
||
| 314 | t = list_get_instance(cur, thread_t, th_link); |
||
| 315 | if (tid == t->tid) return t; |
||
| 316 | } |
||
| 317 | |||
| 318 | return NULL; |
||
| 319 | } |
||
| 320 | |||
| 2801 | svoboda | 321 | #include <console/klog.h> |
| 322 | |||
| 2804 | svoboda | 323 | static int debug_begin(call_t *call, phone_t *phone) |
| 2801 | svoboda | 324 | { |
| 325 | task_t *ta; |
||
| 326 | |||
| 327 | klog_printf("debug_begin()"); |
||
| 2804 | svoboda | 328 | |
| 2801 | svoboda | 329 | ta = get_lock_callee_task(phone); |
| 2804 | svoboda | 330 | klog_printf("debugging task %llu", ta->taskid); |
| 2801 | svoboda | 331 | |
| 332 | if (ta->being_debugged != false) { |
||
| 333 | spinlock_unlock(&ta->lock); |
||
| 2804 | svoboda | 334 | klog_printf("debug_begin(): busy error"); |
| 335 | return EBUSY; |
||
| 2801 | svoboda | 336 | } |
| 337 | |||
| 338 | ta->being_debugged = true; |
||
| 339 | ta->stop_request = true; |
||
| 340 | ta->debug_begin_call = call; |
||
| 2804 | svoboda | 341 | |
| 342 | if (ta->not_stoppable_count == 0) { |
||
| 343 | ta->debug_begin_call = NULL; |
||
| 344 | ta->stop_request = false; |
||
| 345 | spinlock_unlock(&ta->lock); |
||
| 346 | klog_printf("debug_begin(): immediate backsend"); |
||
| 347 | return 1; /* actually we need backsend with 0 retval */ |
||
| 348 | } |
||
| 349 | |||
| 2801 | svoboda | 350 | spinlock_unlock(&ta->lock); |
| 351 | |||
| 2804 | svoboda | 352 | klog_printf("debug_begin() done (wait for stoppability)"); |
| 353 | return 0; |
||
| 2801 | svoboda | 354 | } |
| 355 | |||
| 2807 | svoboda | 356 | static int debug_go(call_t *call, phone_t *phone) |
| 2801 | svoboda | 357 | { |
| 358 | thread_t *t; |
||
| 359 | task_t *ta; |
||
| 360 | |||
| 361 | klog_printf("debug_go()"); |
||
| 362 | ta = get_lock_callee_task(phone); |
||
| 363 | |||
| 2804 | svoboda | 364 | ta->debug_go_call = call; |
| 2807 | svoboda | 365 | t = get_task_thread_by_id(ta, IPC_GET_ARG1(call->data)); |
| 366 | if (t == NULL) { |
||
| 367 | spinlock_unlock(&ta->lock); |
||
| 368 | return ENOENT; |
||
| 2801 | svoboda | 369 | } |
| 370 | |||
| 2807 | svoboda | 371 | klog_printf("debug_go(): waitq_wakeup"); |
| 372 | waitq_wakeup(&t->go_wq, WAKEUP_FIRST); |
||
| 373 | |||
| 2801 | svoboda | 374 | spinlock_unlock(&ta->lock); |
| 2807 | svoboda | 375 | |
| 376 | return 0; /* no backsend */ |
||
| 2801 | svoboda | 377 | } |
| 378 | |||
| 2805 | svoboda | 379 | static int debug_args_read(call_t *call, phone_t *phone) |
| 380 | { |
||
| 381 | thread_t *t; |
||
| 382 | task_t *ta; |
||
| 383 | void *uspace_buffer; |
||
| 384 | unative_t to_copy; |
||
| 385 | int rc; |
||
| 2801 | svoboda | 386 | |
| 2805 | svoboda | 387 | klog_printf("debug_args_read()"); |
| 388 | // FIXME: verify task/thread state |
||
| 389 | |||
| 390 | ta = get_lock_callee_task(phone); |
||
| 391 | klog_printf("task %llu", ta->taskid); |
||
| 2807 | svoboda | 392 | t = get_task_thread_by_id(ta, IPC_GET_ARG1(call->data)); |
| 393 | if (t == NULL) { |
||
| 394 | spinlock_unlock(&ta->lock); |
||
| 395 | return ENOENT; |
||
| 396 | } |
||
| 2805 | svoboda | 397 | |
| 2807 | svoboda | 398 | uspace_buffer = (void *)IPC_GET_ARG2(call->data); |
| 399 | to_copy = IPC_GET_ARG3(call->data); |
||
| 400 | if (to_copy > 6) to_copy = 6; |
||
| 401 | |||
| 402 | rc = copy_to_uspace(uspace_buffer, t->syscall_args, to_copy); |
||
| 403 | if (rc != 0) { |
||
| 404 | spinlock_unlock(&ta->lock); |
||
| 405 | klog_printf("debug_args_read() - copy failed"); |
||
| 406 | return rc; |
||
| 2805 | svoboda | 407 | } |
| 408 | |||
| 409 | spinlock_unlock(&ta->lock); |
||
| 410 | |||
| 2807 | svoboda | 411 | IPC_SET_ARG1(call->data, to_copy); |
| 412 | |||
| 2805 | svoboda | 413 | klog_printf("debug_args_read() done"); |
| 414 | return 1; /* actually need becksend with retval 0 */ |
||
| 415 | } |
||
| 416 | |||
| 2807 | svoboda | 417 | static int debug_thread_read(call_t *call, phone_t *phone) |
| 418 | { |
||
| 419 | thread_t *t; |
||
| 420 | link_t *cur; |
||
| 421 | task_t *ta; |
||
| 422 | unative_t *uspace_buffer; |
||
| 423 | unative_t to_copy; |
||
| 424 | int rc; |
||
| 425 | unsigned copied, total; |
||
| 426 | unsigned buf_size; |
||
| 427 | unative_t tid; |
||
| 2805 | svoboda | 428 | |
| 2807 | svoboda | 429 | klog_printf("debug_thread_read()"); |
| 430 | // FIXME: verify task/thread state |
||
| 431 | |||
| 432 | ta = get_lock_callee_task(phone); |
||
| 433 | klog_printf("task %llu", ta->taskid); |
||
| 434 | |||
| 435 | uspace_buffer = (void *)IPC_GET_ARG1(call->data); |
||
| 436 | buf_size = IPC_GET_ARG2(call->data); |
||
| 437 | |||
| 438 | copied = total = 0; |
||
| 439 | for (cur = ta->th_head.next; cur != &ta->th_head; cur = cur->next) { |
||
| 440 | t = list_get_instance(cur, thread_t, th_link); |
||
| 441 | |||
| 442 | //FIXME: id cropped!! |
||
| 443 | tid = (unative_t) t->tid; |
||
| 444 | |||
| 445 | to_copy = sizeof(unative_t); |
||
| 446 | if (copied + to_copy >= buf_size) |
||
| 447 | to_copy = buf_size - copied; |
||
| 448 | |||
| 449 | if (to_copy > 0) { |
||
| 450 | rc = copy_to_uspace(uspace_buffer, &tid, to_copy); |
||
| 451 | if (rc != 0) { |
||
| 452 | spinlock_unlock(&ta->lock); |
||
| 453 | klog_printf("debug_thread_read() - copy failed"); |
||
| 454 | return rc; |
||
| 455 | } |
||
| 456 | } |
||
| 457 | |||
| 458 | ++uspace_buffer; |
||
| 459 | total += sizeof(unative_t); |
||
| 460 | copied += to_copy; |
||
| 461 | } |
||
| 462 | |||
| 463 | spinlock_unlock(&ta->lock); |
||
| 464 | |||
| 465 | IPC_SET_ARG1(call->data, copied); |
||
| 466 | IPC_SET_ARG2(call->data, total); |
||
| 467 | |||
| 468 | klog_printf("debug_thread_read() done"); |
||
| 469 | return 1; /* actually need becksend with retval 0 */ |
||
| 470 | } |
||
| 471 | |||
| 472 | |||
| 2471 | jermar | 473 | /** Called before the request is sent. |
| 1090 | palkovsky | 474 | * |
| 2471 | jermar | 475 | * @param call Call structure with the request. |
| 2801 | svoboda | 476 | * @param phone Phone that the call will be sent through. |
| 2471 | jermar | 477 | * |
| 478 | * @return Return 0 on success, ELIMIT or EPERM on error. |
||
| 1090 | palkovsky | 479 | */ |
| 2801 | svoboda | 480 | static int request_preprocess(call_t *call, phone_t *phone) |
| 1090 | palkovsky | 481 | { |
| 482 | int newphid; |
||
| 1329 | palkovsky | 483 | size_t size; |
| 2494 | jermar | 484 | uintptr_t src; |
| 485 | int rc; |
||
| 1090 | palkovsky | 486 | |
| 487 | switch (IPC_GET_METHOD(call->data)) { |
||
| 488 | case IPC_M_CONNECT_ME_TO: |
||
| 489 | newphid = phone_alloc(); |
||
| 490 | if (newphid < 0) |
||
| 491 | return ELIMIT; |
||
| 2638 | jermar | 492 | /* Set arg5 for server */ |
| 2635 | cejka | 493 | IPC_SET_ARG5(call->data, (unative_t) &TASK->phones[newphid]); |
| 1090 | palkovsky | 494 | call->flags |= IPC_CALL_CONN_ME_TO; |
| 2098 | decky | 495 | call->priv = newphid; |
| 1090 | palkovsky | 496 | break; |
| 2677 | jermar | 497 | case IPC_M_SHARE_OUT: |
| 2556 | jermar | 498 | size = as_area_get_size(IPC_GET_ARG1(call->data)); |
| 2471 | jermar | 499 | if (!size) |
| 1329 | palkovsky | 500 | return EPERM; |
| 1417 | jermar | 501 | IPC_SET_ARG2(call->data, size); |
| 1329 | palkovsky | 502 | break; |
| 2662 | jermar | 503 | case IPC_M_DATA_READ: |
| 504 | size = IPC_GET_ARG2(call->data); |
||
| 505 | if ((size <= 0 || (size > DATA_XFER_LIMIT))) |
||
| 506 | return ELIMIT; |
||
| 507 | break; |
||
| 2660 | jermar | 508 | case IPC_M_DATA_WRITE: |
| 2676 | jermar | 509 | src = IPC_GET_ARG1(call->data); |
| 510 | size = IPC_GET_ARG2(call->data); |
||
| 2494 | jermar | 511 | |
| 2660 | jermar | 512 | if ((size <= 0) || (size > DATA_XFER_LIMIT)) |
| 2494 | jermar | 513 | return ELIMIT; |
| 514 | |||
| 515 | call->buffer = (uint8_t *) malloc(size, 0); |
||
| 516 | rc = copy_from_uspace(call->buffer, (void *) src, size); |
||
| 517 | if (rc != 0) { |
||
| 518 | free(call->buffer); |
||
| 519 | return rc; |
||
| 520 | } |
||
| 521 | break; |
||
| 2801 | svoboda | 522 | case IPC_M_DEBUG_BEGIN: |
| 2804 | svoboda | 523 | /* actually need possibility of backsend with 0 result code */ |
| 524 | rc = debug_begin(call, phone); |
||
| 2805 | svoboda | 525 | return rc; |
| 2801 | svoboda | 526 | case IPC_M_DEBUG_GO: |
| 2807 | svoboda | 527 | rc = debug_go(call, phone); |
| 528 | return rc; |
||
| 2805 | svoboda | 529 | case IPC_M_DEBUG_ARGS_READ: |
| 530 | rc = debug_args_read(call, phone); |
||
| 531 | return rc; |
||
| 2807 | svoboda | 532 | case IPC_M_DEBUG_THREAD_READ: |
| 533 | rc = debug_thread_read(call, phone); |
||
| 534 | return rc; |
||
| 1090 | palkovsky | 535 | default: |
| 536 | break; |
||
| 537 | } |
||
| 538 | return 0; |
||
| 539 | } |
||
| 540 | |||
| 2471 | jermar | 541 | /******************************************************************************* |
| 542 | * Functions called to process received call/answer before passing it to uspace. |
||
| 543 | *******************************************************************************/ |
||
| 544 | |||
| 545 | /** Do basic kernel processing of received call answer. |
||
| 546 | * |
||
| 547 | * @param call Call structure with the answer. |
||
| 1027 | palkovsky | 548 | */ |
| 1090 | palkovsky | 549 | static void process_answer(call_t *call) |
| 1027 | palkovsky | 550 | { |
| 2745 | decky | 551 | if (((native_t) IPC_GET_RETVAL(call->data) == EHANGUP) && |
| 2359 | jermar | 552 | (call->flags & IPC_CALL_FORWARDED)) |
| 1088 | palkovsky | 553 | IPC_SET_RETVAL(call->data, EFORWARD); |
| 1090 | palkovsky | 554 | |
| 555 | if (call->flags & IPC_CALL_CONN_ME_TO) { |
||
| 556 | if (IPC_GET_RETVAL(call->data)) |
||
| 2098 | decky | 557 | phone_dealloc(call->priv); |
| 1090 | palkovsky | 558 | else |
| 2635 | cejka | 559 | IPC_SET_ARG5(call->data, call->priv); |
| 1090 | palkovsky | 560 | } |
| 2662 | jermar | 561 | |
| 562 | if (call->buffer) { |
||
| 563 | /* This must be an affirmative answer to IPC_M_DATA_READ. */ |
||
| 564 | uintptr_t dst = IPC_GET_ARG1(call->data); |
||
| 565 | size_t size = IPC_GET_ARG2(call->data); |
||
| 566 | int rc = copy_to_uspace((void *) dst, call->buffer, size); |
||
| 567 | if (rc) |
||
| 568 | IPC_SET_RETVAL(call->data, rc); |
||
| 569 | free(call->buffer); |
||
| 570 | call->buffer = NULL; |
||
| 571 | } |
||
| 1027 | palkovsky | 572 | } |
| 573 | |||
| 2471 | jermar | 574 | /** Do basic kernel processing of received call request. |
| 1027 | palkovsky | 575 | * |
| 2471 | jermar | 576 | * @param box Destination answerbox structure. |
| 577 | * @param call Call structure with the request. |
||
| 578 | * |
||
| 579 | * @return Return 0 if the call should be passed to userspace. |
||
| 580 | * Return -1 if the call should be ignored. |
||
| 1027 | palkovsky | 581 | */ |
| 2359 | jermar | 582 | static int process_request(answerbox_t *box, call_t *call) |
| 1027 | palkovsky | 583 | { |
| 584 | int phoneid; |
||
| 585 | |||
| 1086 | palkovsky | 586 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) { |
| 1040 | palkovsky | 587 | phoneid = phone_alloc(); |
| 1027 | palkovsky | 588 | if (phoneid < 0) { /* Failed to allocate phone */ |
| 589 | IPC_SET_RETVAL(call->data, ELIMIT); |
||
| 2471 | jermar | 590 | ipc_answer(box, call); |
| 1027 | palkovsky | 591 | return -1; |
| 592 | } |
||
| 2637 | cejka | 593 | IPC_SET_ARG5(call->data, phoneid); |
| 2801 | svoboda | 594 | } |
| 595 | switch (IPC_GET_METHOD(call->data)) { |
||
| 596 | case IPC_M_DEBUG_BEGIN: |
||
| 597 | case IPC_M_DEBUG_END: |
||
| 598 | case IPC_M_DEBUG_GO: |
||
| 599 | case IPC_M_DEBUG_STOP: |
||
| 600 | case IPC_M_DEBUG_GUARD: |
||
| 601 | return -1; |
||
| 602 | default: |
||
| 603 | break; |
||
| 604 | } |
||
| 1027 | palkovsky | 605 | return 0; |
| 606 | } |
||
| 607 | |||
| 2471 | jermar | 608 | /** Make a fast call over IPC, wait for reply and return to user. |
| 1027 | palkovsky | 609 | * |
| 2615 | jermar | 610 | * This function can handle only three arguments of payload, but is faster than |
| 611 | * the generic function (i.e. sys_ipc_call_sync_slow()). |
||
| 2471 | jermar | 612 | * |
| 613 | * @param phoneid Phone handle for the call. |
||
| 614 | * @param method Method of the call. |
||
| 615 | * @param arg1 Service-defined payload argument. |
||
| 2615 | jermar | 616 | * @param arg2 Service-defined payload argument. |
| 617 | * @param arg3 Service-defined payload argument. |
||
| 2471 | jermar | 618 | * @param data Address of userspace structure where the reply call will |
| 619 | * be stored. |
||
| 620 | * |
||
| 621 | * @return Returns 0 on success. |
||
| 622 | * Return ENOENT if there is no such phone handle. |
||
| 1027 | palkovsky | 623 | */ |
| 2359 | jermar | 624 | unative_t sys_ipc_call_sync_fast(unative_t phoneid, unative_t method, |
| 2615 | jermar | 625 | unative_t arg1, unative_t arg2, unative_t arg3, ipc_data_t *data) |
| 1027 | palkovsky | 626 | { |
| 627 | call_t call; |
||
| 628 | phone_t *phone; |
||
| 1090 | palkovsky | 629 | int res; |
| 2617 | jermar | 630 | int rc; |
| 1027 | palkovsky | 631 | |
| 1084 | palkovsky | 632 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
| 1027 | palkovsky | 633 | |
| 1084 | palkovsky | 634 | ipc_call_static_init(&call); |
| 1027 | palkovsky | 635 | IPC_SET_METHOD(call.data, method); |
| 636 | IPC_SET_ARG1(call.data, arg1); |
||
| 2615 | jermar | 637 | IPC_SET_ARG2(call.data, arg2); |
| 638 | IPC_SET_ARG3(call.data, arg3); |
||
| 2620 | jermar | 639 | /* |
| 640 | * To achieve deterministic behavior, zero out arguments that are beyond |
||
| 641 | * the limits of the fast version. |
||
| 642 | */ |
||
| 643 | IPC_SET_ARG4(call.data, 0); |
||
| 644 | IPC_SET_ARG5(call.data, 0); |
||
| 1027 | palkovsky | 645 | |
| 2801 | svoboda | 646 | if (!(res = request_preprocess(&call, phone))) { |
| 1090 | palkovsky | 647 | ipc_call_sync(phone, &call); |
| 648 | process_answer(&call); |
||
| 2471 | jermar | 649 | } else { |
| 1090 | palkovsky | 650 | IPC_SET_RETVAL(call.data, res); |
| 2471 | jermar | 651 | } |
| 2617 | jermar | 652 | rc = STRUCT_TO_USPACE(&data->args, &call.data.args); |
| 653 | if (rc != 0) |
||
| 654 | return rc; |
||
| 1027 | palkovsky | 655 | |
| 656 | return 0; |
||
| 657 | } |
||
| 658 | |||
| 2471 | jermar | 659 | /** Make a synchronous IPC call allowing to transmit the entire payload. |
| 660 | * |
||
| 661 | * @param phoneid Phone handle for the call. |
||
| 662 | * @param question Userspace address of call data with the request. |
||
| 2494 | jermar | 663 | * @param reply Userspace address of call data where to store the |
| 664 | * answer. |
||
| 2471 | jermar | 665 | * |
| 666 | * @return Zero on success or an error code. |
||
| 667 | */ |
||
| 2615 | jermar | 668 | unative_t sys_ipc_call_sync_slow(unative_t phoneid, ipc_data_t *question, |
| 2359 | jermar | 669 | ipc_data_t *reply) |
| 1027 | palkovsky | 670 | { |
| 671 | call_t call; |
||
| 672 | phone_t *phone; |
||
| 1090 | palkovsky | 673 | int res; |
| 1288 | jermar | 674 | int rc; |
| 1027 | palkovsky | 675 | |
| 1084 | palkovsky | 676 | ipc_call_static_init(&call); |
| 2359 | jermar | 677 | rc = copy_from_uspace(&call.data.args, &question->args, |
| 678 | sizeof(call.data.args)); |
||
| 1288 | jermar | 679 | if (rc != 0) |
| 1780 | jermar | 680 | return (unative_t) rc; |
| 1040 | palkovsky | 681 | |
| 1084 | palkovsky | 682 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
| 1072 | palkovsky | 683 | |
| 2801 | svoboda | 684 | if (!(res = request_preprocess(&call, phone))) { |
| 1090 | palkovsky | 685 | ipc_call_sync(phone, &call); |
| 686 | process_answer(&call); |
||
| 687 | } else |
||
| 688 | IPC_SET_RETVAL(call.data, res); |
||
| 1027 | palkovsky | 689 | |
| 1288 | jermar | 690 | rc = STRUCT_TO_USPACE(&reply->args, &call.data.args); |
| 691 | if (rc != 0) |
||
| 692 | return rc; |
||
| 1027 | palkovsky | 693 | |
| 694 | return 0; |
||
| 695 | } |
||
| 696 | |||
| 2471 | jermar | 697 | /** Check that the task did not exceed the allowed limit of asynchronous calls. |
| 1027 | palkovsky | 698 | * |
| 2471 | jermar | 699 | * @return Return 0 if limit not reached or -1 if limit exceeded. |
| 1027 | palkovsky | 700 | */ |
| 701 | static int check_call_limit(void) |
||
| 702 | { |
||
| 703 | if (atomic_preinc(&TASK->active_calls) > IPC_MAX_ASYNC_CALLS) { |
||
| 704 | atomic_dec(&TASK->active_calls); |
||
| 705 | return -1; |
||
| 706 | } |
||
| 707 | return 0; |
||
| 708 | } |
||
| 709 | |||
| 2471 | jermar | 710 | /** Make a fast asynchronous call over IPC. |
| 1027 | palkovsky | 711 | * |
| 2618 | jermar | 712 | * This function can only handle four arguments of payload, but is faster than |
| 713 | * the generic function sys_ipc_call_async_slow(). |
||
| 2471 | jermar | 714 | * |
| 715 | * @param phoneid Phone handle for the call. |
||
| 716 | * @param method Method of the call. |
||
| 717 | * @param arg1 Service-defined payload argument. |
||
| 718 | * @param arg2 Service-defined payload argument. |
||
| 2618 | jermar | 719 | * @param arg3 Service-defined payload argument. |
| 720 | * @param arg4 Service-defined payload argument. |
||
| 2471 | jermar | 721 | * |
| 722 | * @return Return call hash on success. |
||
| 723 | * Return IPC_CALLRET_FATAL in case of a fatal error and |
||
| 724 | * IPC_CALLRET_TEMPORARY if there are too many pending |
||
| 725 | * asynchronous requests; answers should be handled first. |
||
| 1027 | palkovsky | 726 | */ |
| 2359 | jermar | 727 | unative_t sys_ipc_call_async_fast(unative_t phoneid, unative_t method, |
| 2618 | jermar | 728 | unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4) |
| 1027 | palkovsky | 729 | { |
| 730 | call_t *call; |
||
| 731 | phone_t *phone; |
||
| 1090 | palkovsky | 732 | int res; |
| 1027 | palkovsky | 733 | |
| 734 | if (check_call_limit()) |
||
| 735 | return IPC_CALLRET_TEMPORARY; |
||
| 736 | |||
| 1090 | palkovsky | 737 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
| 1072 | palkovsky | 738 | |
| 1258 | palkovsky | 739 | call = ipc_call_alloc(0); |
| 1027 | palkovsky | 740 | IPC_SET_METHOD(call->data, method); |
| 741 | IPC_SET_ARG1(call->data, arg1); |
||
| 742 | IPC_SET_ARG2(call->data, arg2); |
||
| 2618 | jermar | 743 | IPC_SET_ARG3(call->data, arg3); |
| 744 | IPC_SET_ARG4(call->data, arg4); |
||
| 2620 | jermar | 745 | /* |
| 746 | * To achieve deterministic behavior, zero out arguments that are beyond |
||
| 747 | * the limits of the fast version. |
||
| 748 | */ |
||
| 749 | IPC_SET_ARG5(call->data, 0); |
||
| 1027 | palkovsky | 750 | |
| 2801 | svoboda | 751 | if (!(res = request_preprocess(call, phone))) |
| 1090 | palkovsky | 752 | ipc_call(phone, call); |
| 753 | else |
||
| 754 | ipc_backsend_err(phone, call, res); |
||
| 1027 | palkovsky | 755 | |
| 1780 | jermar | 756 | return (unative_t) call; |
| 1027 | palkovsky | 757 | } |
| 758 | |||
| 2471 | jermar | 759 | /** Make an asynchronous IPC call allowing to transmit the entire payload. |
| 1027 | palkovsky | 760 | * |
| 2471 | jermar | 761 | * @param phoneid Phone handle for the call. |
| 762 | * @param data Userspace address of call data with the request. |
||
| 763 | * |
||
| 764 | * @return See sys_ipc_call_async_fast(). |
||
| 1027 | palkovsky | 765 | */ |
| 2618 | jermar | 766 | unative_t sys_ipc_call_async_slow(unative_t phoneid, ipc_data_t *data) |
| 1027 | palkovsky | 767 | { |
| 768 | call_t *call; |
||
| 769 | phone_t *phone; |
||
| 1090 | palkovsky | 770 | int res; |
| 1288 | jermar | 771 | int rc; |
| 1027 | palkovsky | 772 | |
| 1072 | palkovsky | 773 | if (check_call_limit()) |
| 774 | return IPC_CALLRET_TEMPORARY; |
||
| 775 | |||
| 1090 | palkovsky | 776 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
| 1027 | palkovsky | 777 | |
| 1258 | palkovsky | 778 | call = ipc_call_alloc(0); |
| 2359 | jermar | 779 | rc = copy_from_uspace(&call->data.args, &data->args, |
| 780 | sizeof(call->data.args)); |
||
| 1293 | palkovsky | 781 | if (rc != 0) { |
| 782 | ipc_call_free(call); |
||
| 1780 | jermar | 783 | return (unative_t) rc; |
| 1293 | palkovsky | 784 | } |
| 2801 | svoboda | 785 | if (!(res = request_preprocess(call, phone))) |
| 1090 | palkovsky | 786 | ipc_call(phone, call); |
| 787 | else |
||
| 788 | ipc_backsend_err(phone, call, res); |
||
| 1040 | palkovsky | 789 | |
| 1780 | jermar | 790 | return (unative_t) call; |
| 1027 | palkovsky | 791 | } |
| 792 | |||
| 2471 | jermar | 793 | /** Forward a received call to another destination. |
| 1040 | palkovsky | 794 | * |
| 2471 | jermar | 795 | * @param callid Hash of the call to forward. |
| 796 | * @param phoneid Phone handle to use for forwarding. |
||
| 797 | * @param method New method to use for the forwarded call. |
||
| 798 | * @param arg1 New value of the first argument for the forwarded call. |
||
| 2636 | jermar | 799 | * @param arg2 New value of the second argument for the forwarded call. |
| 2622 | jermar | 800 | * @param mode Flags that specify mode of the forward operation. |
| 1060 | palkovsky | 801 | * |
| 2471 | jermar | 802 | * @return Return 0 on succes, otherwise return an error code. |
| 803 | * |
||
| 2636 | jermar | 804 | * In case the original method is a system method, ARG1, ARG2 and ARG3 are |
| 805 | * overwritten in the forwarded message with the new method and the new arg1 and |
||
| 806 | * arg2, respectively. Otherwise the METHOD, ARG1 and ARG2 are rewritten with |
||
| 807 | * the new method, arg1 and arg2, respectively. Also note there is a set of |
||
| 808 | * immutable methods, for which the new method and argument is not set and |
||
| 809 | * these values are ignored. |
||
| 2471 | jermar | 810 | * |
| 2622 | jermar | 811 | * Warning: When implementing support for changing additional payload |
| 2636 | jermar | 812 | * arguments, make sure that ARG5 is not rewritten for certain |
| 2622 | jermar | 813 | * system IPC |
| 1040 | palkovsky | 814 | */ |
| 1780 | jermar | 815 | unative_t sys_ipc_forward_fast(unative_t callid, unative_t phoneid, |
| 2635 | cejka | 816 | unative_t method, unative_t arg1, unative_t arg2, int mode) |
| 1040 | palkovsky | 817 | { |
| 818 | call_t *call; |
||
| 819 | phone_t *phone; |
||
| 820 | |||
| 821 | call = get_call(callid); |
||
| 822 | if (!call) |
||
| 823 | return ENOENT; |
||
| 824 | |||
| 1088 | palkovsky | 825 | call->flags |= IPC_CALL_FORWARDED; |
| 826 | |||
| 1084 | palkovsky | 827 | GET_CHECK_PHONE(phone, phoneid, { |
| 1040 | palkovsky | 828 | IPC_SET_RETVAL(call->data, EFORWARD); |
| 829 | ipc_answer(&TASK->answerbox, call); |
||
| 830 | return ENOENT; |
||
| 1084 | palkovsky | 831 | }); |
| 1040 | palkovsky | 832 | |
| 2557 | jermar | 833 | if (!method_is_forwardable(IPC_GET_METHOD(call->data))) { |
| 1040 | palkovsky | 834 | IPC_SET_RETVAL(call->data, EFORWARD); |
| 835 | ipc_answer(&TASK->answerbox, call); |
||
| 836 | return EPERM; |
||
| 837 | } |
||
| 838 | |||
| 2557 | jermar | 839 | /* |
| 840 | * Userspace is not allowed to change method of system methods on |
||
| 2635 | cejka | 841 | * forward, allow changing ARG1, ARG2 and ARG3 by means of method, |
| 842 | * arg1 and arg2. |
||
| 2557 | jermar | 843 | * If the method is immutable, don't change anything. |
| 1040 | palkovsky | 844 | */ |
| 2557 | jermar | 845 | if (!method_is_immutable(IPC_GET_METHOD(call->data))) { |
| 846 | if (method_is_system(IPC_GET_METHOD(call->data))) { |
||
| 847 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) |
||
| 2635 | cejka | 848 | phone_dealloc(IPC_GET_ARG5(call->data)); |
| 1090 | palkovsky | 849 | |
| 2557 | jermar | 850 | IPC_SET_ARG1(call->data, method); |
| 851 | IPC_SET_ARG2(call->data, arg1); |
||
| 2635 | cejka | 852 | IPC_SET_ARG3(call->data, arg2); |
| 2557 | jermar | 853 | } else { |
| 854 | IPC_SET_METHOD(call->data, method); |
||
| 855 | IPC_SET_ARG1(call->data, arg1); |
||
| 2635 | cejka | 856 | IPC_SET_ARG2(call->data, arg2); |
| 2557 | jermar | 857 | } |
| 1040 | palkovsky | 858 | } |
| 859 | |||
| 2622 | jermar | 860 | return ipc_forward(call, phone, &TASK->answerbox, mode); |
| 1040 | palkovsky | 861 | } |
| 862 | |||
| 2471 | jermar | 863 | /** Answer an IPC call - fast version. |
| 864 | * |
||
| 865 | * This function can handle only two return arguments of payload, but is faster |
||
| 866 | * than the generic sys_ipc_answer(). |
||
| 867 | * |
||
| 868 | * @param callid Hash of the call to be answered. |
||
| 869 | * @param retval Return value of the answer. |
||
| 870 | * @param arg1 Service-defined return value. |
||
| 871 | * @param arg2 Service-defined return value. |
||
| 2619 | jermar | 872 | * @param arg3 Service-defined return value. |
| 873 | * @param arg4 Service-defined return value. |
||
| 2471 | jermar | 874 | * |
| 875 | * @return Return 0 on success, otherwise return an error code. |
||
| 876 | */ |
||
| 2359 | jermar | 877 | unative_t sys_ipc_answer_fast(unative_t callid, unative_t retval, |
| 2619 | jermar | 878 | unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4) |
| 1027 | palkovsky | 879 | { |
| 880 | call_t *call; |
||
| 1040 | palkovsky | 881 | ipc_data_t saved_data; |
| 1088 | palkovsky | 882 | int saveddata = 0; |
| 1329 | palkovsky | 883 | int rc; |
| 1027 | palkovsky | 884 | |
| 1346 | palkovsky | 885 | /* Do not answer notification callids */ |
| 886 | if (callid & IPC_CALLID_NOTIFICATION) |
||
| 887 | return 0; |
||
| 888 | |||
| 1040 | palkovsky | 889 | call = get_call(callid); |
| 890 | if (!call) |
||
| 891 | return ENOENT; |
||
| 1027 | palkovsky | 892 | |
| 1088 | palkovsky | 893 | if (answer_need_old(call)) { |
| 1040 | palkovsky | 894 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
| 1088 | palkovsky | 895 | saveddata = 1; |
| 1027 | palkovsky | 896 | } |
| 897 | |||
| 898 | IPC_SET_RETVAL(call->data, retval); |
||
| 899 | IPC_SET_ARG1(call->data, arg1); |
||
| 900 | IPC_SET_ARG2(call->data, arg2); |
||
| 2619 | jermar | 901 | IPC_SET_ARG3(call->data, arg3); |
| 902 | IPC_SET_ARG4(call->data, arg4); |
||
| 2620 | jermar | 903 | /* |
| 904 | * To achieve deterministic behavior, zero out arguments that are beyond |
||
| 905 | * the limits of the fast version. |
||
| 906 | */ |
||
| 907 | IPC_SET_ARG5(call->data, 0); |
||
| 1329 | palkovsky | 908 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
| 1040 | palkovsky | 909 | |
| 1027 | palkovsky | 910 | ipc_answer(&TASK->answerbox, call); |
| 1329 | palkovsky | 911 | return rc; |
| 1027 | palkovsky | 912 | } |
| 913 | |||
| 2471 | jermar | 914 | /** Answer an IPC call. |
| 915 | * |
||
| 916 | * @param callid Hash of the call to be answered. |
||
| 917 | * @param data Userspace address of call data with the answer. |
||
| 918 | * |
||
| 919 | * @return Return 0 on success, otherwise return an error code. |
||
| 920 | */ |
||
| 2619 | jermar | 921 | unative_t sys_ipc_answer_slow(unative_t callid, ipc_data_t *data) |
| 1027 | palkovsky | 922 | { |
| 923 | call_t *call; |
||
| 1040 | palkovsky | 924 | ipc_data_t saved_data; |
| 1088 | palkovsky | 925 | int saveddata = 0; |
| 1288 | jermar | 926 | int rc; |
| 1027 | palkovsky | 927 | |
| 1346 | palkovsky | 928 | /* Do not answer notification callids */ |
| 929 | if (callid & IPC_CALLID_NOTIFICATION) |
||
| 930 | return 0; |
||
| 931 | |||
| 1040 | palkovsky | 932 | call = get_call(callid); |
| 933 | if (!call) |
||
| 934 | return ENOENT; |
||
| 1027 | palkovsky | 935 | |
| 1088 | palkovsky | 936 | if (answer_need_old(call)) { |
| 1040 | palkovsky | 937 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
| 1088 | palkovsky | 938 | saveddata = 1; |
| 1027 | palkovsky | 939 | } |
| 1288 | jermar | 940 | rc = copy_from_uspace(&call->data.args, &data->args, |
| 2359 | jermar | 941 | sizeof(call->data.args)); |
| 1288 | jermar | 942 | if (rc != 0) |
| 943 | return rc; |
||
| 1027 | palkovsky | 944 | |
| 1329 | palkovsky | 945 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
| 1027 | palkovsky | 946 | |
| 947 | ipc_answer(&TASK->answerbox, call); |
||
| 948 | |||
| 1329 | palkovsky | 949 | return rc; |
| 1027 | palkovsky | 950 | } |
| 951 | |||
| 2471 | jermar | 952 | /** Hang up a phone. |
| 1086 | palkovsky | 953 | * |
| 2471 | jermar | 954 | * @param Phone handle of the phone to be hung up. |
| 955 | * |
||
| 956 | * @return Return 0 on success or an error code. |
||
| 1086 | palkovsky | 957 | */ |
| 1780 | jermar | 958 | unative_t sys_ipc_hangup(int phoneid) |
| 1086 | palkovsky | 959 | { |
| 960 | phone_t *phone; |
||
| 961 | |||
| 962 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
||
| 963 | |||
| 1591 | palkovsky | 964 | if (ipc_phone_hangup(phone)) |
| 1086 | palkovsky | 965 | return -1; |
| 966 | |||
| 967 | return 0; |
||
| 968 | } |
||
| 969 | |||
| 2471 | jermar | 970 | /** Wait for an incoming IPC call or an answer. |
| 1027 | palkovsky | 971 | * |
| 2359 | jermar | 972 | * @param calldata Pointer to buffer where the call/answer data is stored. |
| 973 | * @param usec Timeout. See waitq_sleep_timeout() for explanation. |
||
| 974 | * @param flags Select mode of sleep operation. See waitq_sleep_timeout() |
||
| 975 | * for explanation. |
||
| 1364 | jermar | 976 | * |
| 2471 | jermar | 977 | * @return Hash of the call. |
| 978 | * If IPC_CALLID_NOTIFICATION bit is set in the hash, the |
||
| 979 | * call is a notification. IPC_CALLID_ANSWERED denotes an |
||
| 980 | * answer. |
||
| 1027 | palkovsky | 981 | */ |
| 1780 | jermar | 982 | unative_t sys_ipc_wait_for_call(ipc_data_t *calldata, uint32_t usec, int flags) |
| 1027 | palkovsky | 983 | { |
| 984 | call_t *call; |
||
| 985 | |||
| 986 | restart: |
||
| 2359 | jermar | 987 | call = ipc_wait_for_call(&TASK->answerbox, usec, |
| 988 | flags | SYNCH_FLAGS_INTERRUPTIBLE); |
||
| 1088 | palkovsky | 989 | if (!call) |
| 990 | return 0; |
||
| 1027 | palkovsky | 991 | |
| 1258 | palkovsky | 992 | if (call->flags & IPC_CALL_NOTIF) { |
| 993 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
||
| 1693 | palkovsky | 994 | |
| 995 | /* Set in_phone_hash to the interrupt counter */ |
||
| 2098 | decky | 996 | call->data.phone = (void *) call->priv; |
| 1693 | palkovsky | 997 | |
| 998 | STRUCT_TO_USPACE(calldata, &call->data); |
||
| 999 | |||
| 1258 | palkovsky | 1000 | ipc_call_free(call); |
| 1001 | |||
| 2471 | jermar | 1002 | return ((unative_t) call) | IPC_CALLID_NOTIFICATION; |
| 1258 | palkovsky | 1003 | } |
| 1004 | |||
| 1027 | palkovsky | 1005 | if (call->flags & IPC_CALL_ANSWERED) { |
| 1090 | palkovsky | 1006 | process_answer(call); |
| 1027 | palkovsky | 1007 | |
| 1086 | palkovsky | 1008 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
| 1009 | |||
| 1027 | palkovsky | 1010 | atomic_dec(&TASK->active_calls); |
| 1086 | palkovsky | 1011 | |
| 1012 | if (call->flags & IPC_CALL_DISCARD_ANSWER) { |
||
| 1013 | ipc_call_free(call); |
||
| 1014 | goto restart; |
||
| 1015 | } |
||
| 1016 | |||
| 1017 | STRUCT_TO_USPACE(&calldata->args, &call->data.args); |
||
| 1027 | palkovsky | 1018 | ipc_call_free(call); |
| 1019 | |||
| 2471 | jermar | 1020 | return ((unative_t) call) | IPC_CALLID_ANSWERED; |
| 1027 | palkovsky | 1021 | } |
| 1086 | palkovsky | 1022 | |
| 1027 | palkovsky | 1023 | if (process_request(&TASK->answerbox, call)) |
| 1024 | goto restart; |
||
| 1086 | palkovsky | 1025 | |
| 1090 | palkovsky | 1026 | /* Include phone address('id') of the caller in the request, |
| 1027 | * copy whole call->data, not only call->data.args */ |
||
| 1396 | palkovsky | 1028 | if (STRUCT_TO_USPACE(calldata, &call->data)) { |
| 1029 | return 0; |
||
| 1030 | } |
||
| 1780 | jermar | 1031 | return (unative_t)call; |
| 1027 | palkovsky | 1032 | } |
| 1258 | palkovsky | 1033 | |
| 2471 | jermar | 1034 | /** Connect an IRQ handler to a task. |
| 1923 | jermar | 1035 | * |
| 2471 | jermar | 1036 | * @param inr IRQ number. |
| 1037 | * @param devno Device number. |
||
| 1038 | * @param method Method to be associated with the notification. |
||
| 1039 | * @param ucode Uspace pointer to the top-half pseudocode. |
||
| 1923 | jermar | 1040 | * |
| 2471 | jermar | 1041 | * @return EPERM or a return code returned by ipc_irq_register(). |
| 1923 | jermar | 1042 | */ |
| 2359 | jermar | 1043 | unative_t sys_ipc_register_irq(inr_t inr, devno_t devno, unative_t method, |
| 1044 | irq_code_t *ucode) |
||
| 1258 | palkovsky | 1045 | { |
| 1297 | jermar | 1046 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
| 1047 | return EPERM; |
||
| 1048 | |||
| 1923 | jermar | 1049 | return ipc_irq_register(&TASK->answerbox, inr, devno, method, ucode); |
| 1258 | palkovsky | 1050 | } |
| 1051 | |||
| 2471 | jermar | 1052 | /** Disconnect an IRQ handler from a task. |
| 1923 | jermar | 1053 | * |
| 2471 | jermar | 1054 | * @param inr IRQ number. |
| 1055 | * @param devno Device number. |
||
| 1056 | * |
||
| 1057 | * @return Zero on success or EPERM on error.. |
||
| 1923 | jermar | 1058 | */ |
| 1059 | unative_t sys_ipc_unregister_irq(inr_t inr, devno_t devno) |
||
| 1258 | palkovsky | 1060 | { |
| 1297 | jermar | 1061 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
| 1062 | return EPERM; |
||
| 1063 | |||
| 1923 | jermar | 1064 | ipc_irq_unregister(&TASK->answerbox, inr, devno); |
| 1258 | palkovsky | 1065 | |
| 1066 | return 0; |
||
| 1067 | } |
||
| 1702 | cejka | 1068 | |
| 2801 | svoboda | 1069 | #include <console/klog.h> |
| 1070 | |||
| 1071 | /** |
||
| 1072 | * Syscall connect to a task by id. |
||
| 1073 | * |
||
| 1074 | * @return Phone id on success, or negative error code. |
||
| 1075 | */ |
||
| 1076 | unative_t sys_ipc_connect_task(sysarg64_t *uspace_taskid_arg) |
||
| 1077 | { |
||
| 1078 | sysarg64_t taskid_arg; |
||
| 1079 | int rc; |
||
| 1080 | |||
| 1081 | rc = copy_from_uspace(&taskid_arg, uspace_taskid_arg, sizeof(sysarg64_t)); |
||
| 1082 | if (rc != 0) |
||
| 1083 | return (unative_t) rc; |
||
| 1084 | |||
| 1085 | klog_printf("sys_ipc_connect_kbox(%lld, %d)", taskid_arg.value); |
||
| 1086 | |||
| 1087 | return ipc_connect_task(taskid_arg.value); |
||
| 1088 | } |
||
| 1089 | |||
| 1757 | jermar | 1090 | /** @} |
| 1702 | cejka | 1091 | */ |