Rev 2807 | Rev 2809 | 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); |
||
| 2808 | svoboda | 441 | |
| 442 | /* Not interested in kernel threads */ |
||
| 443 | if ((t->flags & THREAD_FLAG_USPACE) == 0) |
||
| 444 | continue; |
||
| 445 | |||
| 2807 | svoboda | 446 | //FIXME: id cropped!! |
| 447 | tid = (unative_t) t->tid; |
||
| 448 | |||
| 449 | to_copy = sizeof(unative_t); |
||
| 450 | if (copied + to_copy >= buf_size) |
||
| 451 | to_copy = buf_size - copied; |
||
| 452 | |||
| 453 | if (to_copy > 0) { |
||
| 454 | rc = copy_to_uspace(uspace_buffer, &tid, to_copy); |
||
| 455 | if (rc != 0) { |
||
| 456 | spinlock_unlock(&ta->lock); |
||
| 457 | klog_printf("debug_thread_read() - copy failed"); |
||
| 458 | return rc; |
||
| 459 | } |
||
| 460 | } |
||
| 461 | |||
| 462 | ++uspace_buffer; |
||
| 463 | total += sizeof(unative_t); |
||
| 464 | copied += to_copy; |
||
| 465 | } |
||
| 466 | |||
| 467 | spinlock_unlock(&ta->lock); |
||
| 468 | |||
| 469 | IPC_SET_ARG1(call->data, copied); |
||
| 470 | IPC_SET_ARG2(call->data, total); |
||
| 471 | |||
| 472 | klog_printf("debug_thread_read() done"); |
||
| 473 | return 1; /* actually need becksend with retval 0 */ |
||
| 474 | } |
||
| 475 | |||
| 476 | |||
| 2471 | jermar | 477 | /** Called before the request is sent. |
| 1090 | palkovsky | 478 | * |
| 2471 | jermar | 479 | * @param call Call structure with the request. |
| 2801 | svoboda | 480 | * @param phone Phone that the call will be sent through. |
| 2471 | jermar | 481 | * |
| 482 | * @return Return 0 on success, ELIMIT or EPERM on error. |
||
| 1090 | palkovsky | 483 | */ |
| 2801 | svoboda | 484 | static int request_preprocess(call_t *call, phone_t *phone) |
| 1090 | palkovsky | 485 | { |
| 486 | int newphid; |
||
| 1329 | palkovsky | 487 | size_t size; |
| 2494 | jermar | 488 | uintptr_t src; |
| 489 | int rc; |
||
| 1090 | palkovsky | 490 | |
| 491 | switch (IPC_GET_METHOD(call->data)) { |
||
| 492 | case IPC_M_CONNECT_ME_TO: |
||
| 493 | newphid = phone_alloc(); |
||
| 494 | if (newphid < 0) |
||
| 495 | return ELIMIT; |
||
| 2638 | jermar | 496 | /* Set arg5 for server */ |
| 2635 | cejka | 497 | IPC_SET_ARG5(call->data, (unative_t) &TASK->phones[newphid]); |
| 1090 | palkovsky | 498 | call->flags |= IPC_CALL_CONN_ME_TO; |
| 2098 | decky | 499 | call->priv = newphid; |
| 1090 | palkovsky | 500 | break; |
| 2677 | jermar | 501 | case IPC_M_SHARE_OUT: |
| 2556 | jermar | 502 | size = as_area_get_size(IPC_GET_ARG1(call->data)); |
| 2471 | jermar | 503 | if (!size) |
| 1329 | palkovsky | 504 | return EPERM; |
| 1417 | jermar | 505 | IPC_SET_ARG2(call->data, size); |
| 1329 | palkovsky | 506 | break; |
| 2662 | jermar | 507 | case IPC_M_DATA_READ: |
| 508 | size = IPC_GET_ARG2(call->data); |
||
| 509 | if ((size <= 0 || (size > DATA_XFER_LIMIT))) |
||
| 510 | return ELIMIT; |
||
| 511 | break; |
||
| 2660 | jermar | 512 | case IPC_M_DATA_WRITE: |
| 2676 | jermar | 513 | src = IPC_GET_ARG1(call->data); |
| 514 | size = IPC_GET_ARG2(call->data); |
||
| 2494 | jermar | 515 | |
| 2660 | jermar | 516 | if ((size <= 0) || (size > DATA_XFER_LIMIT)) |
| 2494 | jermar | 517 | return ELIMIT; |
| 518 | |||
| 519 | call->buffer = (uint8_t *) malloc(size, 0); |
||
| 520 | rc = copy_from_uspace(call->buffer, (void *) src, size); |
||
| 521 | if (rc != 0) { |
||
| 522 | free(call->buffer); |
||
| 523 | return rc; |
||
| 524 | } |
||
| 525 | break; |
||
| 2801 | svoboda | 526 | case IPC_M_DEBUG_BEGIN: |
| 2804 | svoboda | 527 | /* actually need possibility of backsend with 0 result code */ |
| 528 | rc = debug_begin(call, phone); |
||
| 2805 | svoboda | 529 | return rc; |
| 2801 | svoboda | 530 | case IPC_M_DEBUG_GO: |
| 2807 | svoboda | 531 | rc = debug_go(call, phone); |
| 532 | return rc; |
||
| 2805 | svoboda | 533 | case IPC_M_DEBUG_ARGS_READ: |
| 534 | rc = debug_args_read(call, phone); |
||
| 535 | return rc; |
||
| 2807 | svoboda | 536 | case IPC_M_DEBUG_THREAD_READ: |
| 537 | rc = debug_thread_read(call, phone); |
||
| 538 | return rc; |
||
| 1090 | palkovsky | 539 | default: |
| 540 | break; |
||
| 541 | } |
||
| 542 | return 0; |
||
| 543 | } |
||
| 544 | |||
| 2471 | jermar | 545 | /******************************************************************************* |
| 546 | * Functions called to process received call/answer before passing it to uspace. |
||
| 547 | *******************************************************************************/ |
||
| 548 | |||
| 549 | /** Do basic kernel processing of received call answer. |
||
| 550 | * |
||
| 551 | * @param call Call structure with the answer. |
||
| 1027 | palkovsky | 552 | */ |
| 1090 | palkovsky | 553 | static void process_answer(call_t *call) |
| 1027 | palkovsky | 554 | { |
| 2745 | decky | 555 | if (((native_t) IPC_GET_RETVAL(call->data) == EHANGUP) && |
| 2359 | jermar | 556 | (call->flags & IPC_CALL_FORWARDED)) |
| 1088 | palkovsky | 557 | IPC_SET_RETVAL(call->data, EFORWARD); |
| 1090 | palkovsky | 558 | |
| 559 | if (call->flags & IPC_CALL_CONN_ME_TO) { |
||
| 560 | if (IPC_GET_RETVAL(call->data)) |
||
| 2098 | decky | 561 | phone_dealloc(call->priv); |
| 1090 | palkovsky | 562 | else |
| 2635 | cejka | 563 | IPC_SET_ARG5(call->data, call->priv); |
| 1090 | palkovsky | 564 | } |
| 2662 | jermar | 565 | |
| 566 | if (call->buffer) { |
||
| 567 | /* This must be an affirmative answer to IPC_M_DATA_READ. */ |
||
| 568 | uintptr_t dst = IPC_GET_ARG1(call->data); |
||
| 569 | size_t size = IPC_GET_ARG2(call->data); |
||
| 570 | int rc = copy_to_uspace((void *) dst, call->buffer, size); |
||
| 571 | if (rc) |
||
| 572 | IPC_SET_RETVAL(call->data, rc); |
||
| 573 | free(call->buffer); |
||
| 574 | call->buffer = NULL; |
||
| 575 | } |
||
| 1027 | palkovsky | 576 | } |
| 577 | |||
| 2471 | jermar | 578 | /** Do basic kernel processing of received call request. |
| 1027 | palkovsky | 579 | * |
| 2471 | jermar | 580 | * @param box Destination answerbox structure. |
| 581 | * @param call Call structure with the request. |
||
| 582 | * |
||
| 583 | * @return Return 0 if the call should be passed to userspace. |
||
| 584 | * Return -1 if the call should be ignored. |
||
| 1027 | palkovsky | 585 | */ |
| 2359 | jermar | 586 | static int process_request(answerbox_t *box, call_t *call) |
| 1027 | palkovsky | 587 | { |
| 588 | int phoneid; |
||
| 589 | |||
| 1086 | palkovsky | 590 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) { |
| 1040 | palkovsky | 591 | phoneid = phone_alloc(); |
| 1027 | palkovsky | 592 | if (phoneid < 0) { /* Failed to allocate phone */ |
| 593 | IPC_SET_RETVAL(call->data, ELIMIT); |
||
| 2471 | jermar | 594 | ipc_answer(box, call); |
| 1027 | palkovsky | 595 | return -1; |
| 596 | } |
||
| 2637 | cejka | 597 | IPC_SET_ARG5(call->data, phoneid); |
| 2801 | svoboda | 598 | } |
| 599 | switch (IPC_GET_METHOD(call->data)) { |
||
| 600 | case IPC_M_DEBUG_BEGIN: |
||
| 601 | case IPC_M_DEBUG_END: |
||
| 602 | case IPC_M_DEBUG_GO: |
||
| 603 | case IPC_M_DEBUG_STOP: |
||
| 604 | case IPC_M_DEBUG_GUARD: |
||
| 605 | return -1; |
||
| 606 | default: |
||
| 607 | break; |
||
| 608 | } |
||
| 1027 | palkovsky | 609 | return 0; |
| 610 | } |
||
| 611 | |||
| 2471 | jermar | 612 | /** Make a fast call over IPC, wait for reply and return to user. |
| 1027 | palkovsky | 613 | * |
| 2615 | jermar | 614 | * This function can handle only three arguments of payload, but is faster than |
| 615 | * the generic function (i.e. sys_ipc_call_sync_slow()). |
||
| 2471 | jermar | 616 | * |
| 617 | * @param phoneid Phone handle for the call. |
||
| 618 | * @param method Method of the call. |
||
| 619 | * @param arg1 Service-defined payload argument. |
||
| 2615 | jermar | 620 | * @param arg2 Service-defined payload argument. |
| 621 | * @param arg3 Service-defined payload argument. |
||
| 2471 | jermar | 622 | * @param data Address of userspace structure where the reply call will |
| 623 | * be stored. |
||
| 624 | * |
||
| 625 | * @return Returns 0 on success. |
||
| 626 | * Return ENOENT if there is no such phone handle. |
||
| 1027 | palkovsky | 627 | */ |
| 2359 | jermar | 628 | unative_t sys_ipc_call_sync_fast(unative_t phoneid, unative_t method, |
| 2615 | jermar | 629 | unative_t arg1, unative_t arg2, unative_t arg3, ipc_data_t *data) |
| 1027 | palkovsky | 630 | { |
| 631 | call_t call; |
||
| 632 | phone_t *phone; |
||
| 1090 | palkovsky | 633 | int res; |
| 2617 | jermar | 634 | int rc; |
| 1027 | palkovsky | 635 | |
| 1084 | palkovsky | 636 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
| 1027 | palkovsky | 637 | |
| 1084 | palkovsky | 638 | ipc_call_static_init(&call); |
| 1027 | palkovsky | 639 | IPC_SET_METHOD(call.data, method); |
| 640 | IPC_SET_ARG1(call.data, arg1); |
||
| 2615 | jermar | 641 | IPC_SET_ARG2(call.data, arg2); |
| 642 | IPC_SET_ARG3(call.data, arg3); |
||
| 2620 | jermar | 643 | /* |
| 644 | * To achieve deterministic behavior, zero out arguments that are beyond |
||
| 645 | * the limits of the fast version. |
||
| 646 | */ |
||
| 647 | IPC_SET_ARG4(call.data, 0); |
||
| 648 | IPC_SET_ARG5(call.data, 0); |
||
| 1027 | palkovsky | 649 | |
| 2801 | svoboda | 650 | if (!(res = request_preprocess(&call, phone))) { |
| 1090 | palkovsky | 651 | ipc_call_sync(phone, &call); |
| 652 | process_answer(&call); |
||
| 2471 | jermar | 653 | } else { |
| 1090 | palkovsky | 654 | IPC_SET_RETVAL(call.data, res); |
| 2471 | jermar | 655 | } |
| 2617 | jermar | 656 | rc = STRUCT_TO_USPACE(&data->args, &call.data.args); |
| 657 | if (rc != 0) |
||
| 658 | return rc; |
||
| 1027 | palkovsky | 659 | |
| 660 | return 0; |
||
| 661 | } |
||
| 662 | |||
| 2471 | jermar | 663 | /** Make a synchronous IPC call allowing to transmit the entire payload. |
| 664 | * |
||
| 665 | * @param phoneid Phone handle for the call. |
||
| 666 | * @param question Userspace address of call data with the request. |
||
| 2494 | jermar | 667 | * @param reply Userspace address of call data where to store the |
| 668 | * answer. |
||
| 2471 | jermar | 669 | * |
| 670 | * @return Zero on success or an error code. |
||
| 671 | */ |
||
| 2615 | jermar | 672 | unative_t sys_ipc_call_sync_slow(unative_t phoneid, ipc_data_t *question, |
| 2359 | jermar | 673 | ipc_data_t *reply) |
| 1027 | palkovsky | 674 | { |
| 675 | call_t call; |
||
| 676 | phone_t *phone; |
||
| 1090 | palkovsky | 677 | int res; |
| 1288 | jermar | 678 | int rc; |
| 1027 | palkovsky | 679 | |
| 1084 | palkovsky | 680 | ipc_call_static_init(&call); |
| 2359 | jermar | 681 | rc = copy_from_uspace(&call.data.args, &question->args, |
| 682 | sizeof(call.data.args)); |
||
| 1288 | jermar | 683 | if (rc != 0) |
| 1780 | jermar | 684 | return (unative_t) rc; |
| 1040 | palkovsky | 685 | |
| 1084 | palkovsky | 686 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
| 1072 | palkovsky | 687 | |
| 2801 | svoboda | 688 | if (!(res = request_preprocess(&call, phone))) { |
| 1090 | palkovsky | 689 | ipc_call_sync(phone, &call); |
| 690 | process_answer(&call); |
||
| 691 | } else |
||
| 692 | IPC_SET_RETVAL(call.data, res); |
||
| 1027 | palkovsky | 693 | |
| 1288 | jermar | 694 | rc = STRUCT_TO_USPACE(&reply->args, &call.data.args); |
| 695 | if (rc != 0) |
||
| 696 | return rc; |
||
| 1027 | palkovsky | 697 | |
| 698 | return 0; |
||
| 699 | } |
||
| 700 | |||
| 2471 | jermar | 701 | /** Check that the task did not exceed the allowed limit of asynchronous calls. |
| 1027 | palkovsky | 702 | * |
| 2471 | jermar | 703 | * @return Return 0 if limit not reached or -1 if limit exceeded. |
| 1027 | palkovsky | 704 | */ |
| 705 | static int check_call_limit(void) |
||
| 706 | { |
||
| 707 | if (atomic_preinc(&TASK->active_calls) > IPC_MAX_ASYNC_CALLS) { |
||
| 708 | atomic_dec(&TASK->active_calls); |
||
| 709 | return -1; |
||
| 710 | } |
||
| 711 | return 0; |
||
| 712 | } |
||
| 713 | |||
| 2471 | jermar | 714 | /** Make a fast asynchronous call over IPC. |
| 1027 | palkovsky | 715 | * |
| 2618 | jermar | 716 | * This function can only handle four arguments of payload, but is faster than |
| 717 | * the generic function sys_ipc_call_async_slow(). |
||
| 2471 | jermar | 718 | * |
| 719 | * @param phoneid Phone handle for the call. |
||
| 720 | * @param method Method of the call. |
||
| 721 | * @param arg1 Service-defined payload argument. |
||
| 722 | * @param arg2 Service-defined payload argument. |
||
| 2618 | jermar | 723 | * @param arg3 Service-defined payload argument. |
| 724 | * @param arg4 Service-defined payload argument. |
||
| 2471 | jermar | 725 | * |
| 726 | * @return Return call hash on success. |
||
| 727 | * Return IPC_CALLRET_FATAL in case of a fatal error and |
||
| 728 | * IPC_CALLRET_TEMPORARY if there are too many pending |
||
| 729 | * asynchronous requests; answers should be handled first. |
||
| 1027 | palkovsky | 730 | */ |
| 2359 | jermar | 731 | unative_t sys_ipc_call_async_fast(unative_t phoneid, unative_t method, |
| 2618 | jermar | 732 | unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4) |
| 1027 | palkovsky | 733 | { |
| 734 | call_t *call; |
||
| 735 | phone_t *phone; |
||
| 1090 | palkovsky | 736 | int res; |
| 1027 | palkovsky | 737 | |
| 738 | if (check_call_limit()) |
||
| 739 | return IPC_CALLRET_TEMPORARY; |
||
| 740 | |||
| 1090 | palkovsky | 741 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
| 1072 | palkovsky | 742 | |
| 1258 | palkovsky | 743 | call = ipc_call_alloc(0); |
| 1027 | palkovsky | 744 | IPC_SET_METHOD(call->data, method); |
| 745 | IPC_SET_ARG1(call->data, arg1); |
||
| 746 | IPC_SET_ARG2(call->data, arg2); |
||
| 2618 | jermar | 747 | IPC_SET_ARG3(call->data, arg3); |
| 748 | IPC_SET_ARG4(call->data, arg4); |
||
| 2620 | jermar | 749 | /* |
| 750 | * To achieve deterministic behavior, zero out arguments that are beyond |
||
| 751 | * the limits of the fast version. |
||
| 752 | */ |
||
| 753 | IPC_SET_ARG5(call->data, 0); |
||
| 1027 | palkovsky | 754 | |
| 2801 | svoboda | 755 | if (!(res = request_preprocess(call, phone))) |
| 1090 | palkovsky | 756 | ipc_call(phone, call); |
| 757 | else |
||
| 758 | ipc_backsend_err(phone, call, res); |
||
| 1027 | palkovsky | 759 | |
| 1780 | jermar | 760 | return (unative_t) call; |
| 1027 | palkovsky | 761 | } |
| 762 | |||
| 2471 | jermar | 763 | /** Make an asynchronous IPC call allowing to transmit the entire payload. |
| 1027 | palkovsky | 764 | * |
| 2471 | jermar | 765 | * @param phoneid Phone handle for the call. |
| 766 | * @param data Userspace address of call data with the request. |
||
| 767 | * |
||
| 768 | * @return See sys_ipc_call_async_fast(). |
||
| 1027 | palkovsky | 769 | */ |
| 2618 | jermar | 770 | unative_t sys_ipc_call_async_slow(unative_t phoneid, ipc_data_t *data) |
| 1027 | palkovsky | 771 | { |
| 772 | call_t *call; |
||
| 773 | phone_t *phone; |
||
| 1090 | palkovsky | 774 | int res; |
| 1288 | jermar | 775 | int rc; |
| 1027 | palkovsky | 776 | |
| 1072 | palkovsky | 777 | if (check_call_limit()) |
| 778 | return IPC_CALLRET_TEMPORARY; |
||
| 779 | |||
| 1090 | palkovsky | 780 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
| 1027 | palkovsky | 781 | |
| 1258 | palkovsky | 782 | call = ipc_call_alloc(0); |
| 2359 | jermar | 783 | rc = copy_from_uspace(&call->data.args, &data->args, |
| 784 | sizeof(call->data.args)); |
||
| 1293 | palkovsky | 785 | if (rc != 0) { |
| 786 | ipc_call_free(call); |
||
| 1780 | jermar | 787 | return (unative_t) rc; |
| 1293 | palkovsky | 788 | } |
| 2801 | svoboda | 789 | if (!(res = request_preprocess(call, phone))) |
| 1090 | palkovsky | 790 | ipc_call(phone, call); |
| 791 | else |
||
| 792 | ipc_backsend_err(phone, call, res); |
||
| 1040 | palkovsky | 793 | |
| 1780 | jermar | 794 | return (unative_t) call; |
| 1027 | palkovsky | 795 | } |
| 796 | |||
| 2471 | jermar | 797 | /** Forward a received call to another destination. |
| 1040 | palkovsky | 798 | * |
| 2471 | jermar | 799 | * @param callid Hash of the call to forward. |
| 800 | * @param phoneid Phone handle to use for forwarding. |
||
| 801 | * @param method New method to use for the forwarded call. |
||
| 802 | * @param arg1 New value of the first argument for the forwarded call. |
||
| 2636 | jermar | 803 | * @param arg2 New value of the second argument for the forwarded call. |
| 2622 | jermar | 804 | * @param mode Flags that specify mode of the forward operation. |
| 1060 | palkovsky | 805 | * |
| 2471 | jermar | 806 | * @return Return 0 on succes, otherwise return an error code. |
| 807 | * |
||
| 2636 | jermar | 808 | * In case the original method is a system method, ARG1, ARG2 and ARG3 are |
| 809 | * overwritten in the forwarded message with the new method and the new arg1 and |
||
| 810 | * arg2, respectively. Otherwise the METHOD, ARG1 and ARG2 are rewritten with |
||
| 811 | * the new method, arg1 and arg2, respectively. Also note there is a set of |
||
| 812 | * immutable methods, for which the new method and argument is not set and |
||
| 813 | * these values are ignored. |
||
| 2471 | jermar | 814 | * |
| 2622 | jermar | 815 | * Warning: When implementing support for changing additional payload |
| 2636 | jermar | 816 | * arguments, make sure that ARG5 is not rewritten for certain |
| 2622 | jermar | 817 | * system IPC |
| 1040 | palkovsky | 818 | */ |
| 1780 | jermar | 819 | unative_t sys_ipc_forward_fast(unative_t callid, unative_t phoneid, |
| 2635 | cejka | 820 | unative_t method, unative_t arg1, unative_t arg2, int mode) |
| 1040 | palkovsky | 821 | { |
| 822 | call_t *call; |
||
| 823 | phone_t *phone; |
||
| 824 | |||
| 825 | call = get_call(callid); |
||
| 826 | if (!call) |
||
| 827 | return ENOENT; |
||
| 828 | |||
| 1088 | palkovsky | 829 | call->flags |= IPC_CALL_FORWARDED; |
| 830 | |||
| 1084 | palkovsky | 831 | GET_CHECK_PHONE(phone, phoneid, { |
| 1040 | palkovsky | 832 | IPC_SET_RETVAL(call->data, EFORWARD); |
| 833 | ipc_answer(&TASK->answerbox, call); |
||
| 834 | return ENOENT; |
||
| 1084 | palkovsky | 835 | }); |
| 1040 | palkovsky | 836 | |
| 2557 | jermar | 837 | if (!method_is_forwardable(IPC_GET_METHOD(call->data))) { |
| 1040 | palkovsky | 838 | IPC_SET_RETVAL(call->data, EFORWARD); |
| 839 | ipc_answer(&TASK->answerbox, call); |
||
| 840 | return EPERM; |
||
| 841 | } |
||
| 842 | |||
| 2557 | jermar | 843 | /* |
| 844 | * Userspace is not allowed to change method of system methods on |
||
| 2635 | cejka | 845 | * forward, allow changing ARG1, ARG2 and ARG3 by means of method, |
| 846 | * arg1 and arg2. |
||
| 2557 | jermar | 847 | * If the method is immutable, don't change anything. |
| 1040 | palkovsky | 848 | */ |
| 2557 | jermar | 849 | if (!method_is_immutable(IPC_GET_METHOD(call->data))) { |
| 850 | if (method_is_system(IPC_GET_METHOD(call->data))) { |
||
| 851 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) |
||
| 2635 | cejka | 852 | phone_dealloc(IPC_GET_ARG5(call->data)); |
| 1090 | palkovsky | 853 | |
| 2557 | jermar | 854 | IPC_SET_ARG1(call->data, method); |
| 855 | IPC_SET_ARG2(call->data, arg1); |
||
| 2635 | cejka | 856 | IPC_SET_ARG3(call->data, arg2); |
| 2557 | jermar | 857 | } else { |
| 858 | IPC_SET_METHOD(call->data, method); |
||
| 859 | IPC_SET_ARG1(call->data, arg1); |
||
| 2635 | cejka | 860 | IPC_SET_ARG2(call->data, arg2); |
| 2557 | jermar | 861 | } |
| 1040 | palkovsky | 862 | } |
| 863 | |||
| 2622 | jermar | 864 | return ipc_forward(call, phone, &TASK->answerbox, mode); |
| 1040 | palkovsky | 865 | } |
| 866 | |||
| 2471 | jermar | 867 | /** Answer an IPC call - fast version. |
| 868 | * |
||
| 869 | * This function can handle only two return arguments of payload, but is faster |
||
| 870 | * than the generic sys_ipc_answer(). |
||
| 871 | * |
||
| 872 | * @param callid Hash of the call to be answered. |
||
| 873 | * @param retval Return value of the answer. |
||
| 874 | * @param arg1 Service-defined return value. |
||
| 875 | * @param arg2 Service-defined return value. |
||
| 2619 | jermar | 876 | * @param arg3 Service-defined return value. |
| 877 | * @param arg4 Service-defined return value. |
||
| 2471 | jermar | 878 | * |
| 879 | * @return Return 0 on success, otherwise return an error code. |
||
| 880 | */ |
||
| 2359 | jermar | 881 | unative_t sys_ipc_answer_fast(unative_t callid, unative_t retval, |
| 2619 | jermar | 882 | unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4) |
| 1027 | palkovsky | 883 | { |
| 884 | call_t *call; |
||
| 1040 | palkovsky | 885 | ipc_data_t saved_data; |
| 1088 | palkovsky | 886 | int saveddata = 0; |
| 1329 | palkovsky | 887 | int rc; |
| 1027 | palkovsky | 888 | |
| 1346 | palkovsky | 889 | /* Do not answer notification callids */ |
| 890 | if (callid & IPC_CALLID_NOTIFICATION) |
||
| 891 | return 0; |
||
| 892 | |||
| 1040 | palkovsky | 893 | call = get_call(callid); |
| 894 | if (!call) |
||
| 895 | return ENOENT; |
||
| 1027 | palkovsky | 896 | |
| 1088 | palkovsky | 897 | if (answer_need_old(call)) { |
| 1040 | palkovsky | 898 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
| 1088 | palkovsky | 899 | saveddata = 1; |
| 1027 | palkovsky | 900 | } |
| 901 | |||
| 902 | IPC_SET_RETVAL(call->data, retval); |
||
| 903 | IPC_SET_ARG1(call->data, arg1); |
||
| 904 | IPC_SET_ARG2(call->data, arg2); |
||
| 2619 | jermar | 905 | IPC_SET_ARG3(call->data, arg3); |
| 906 | IPC_SET_ARG4(call->data, arg4); |
||
| 2620 | jermar | 907 | /* |
| 908 | * To achieve deterministic behavior, zero out arguments that are beyond |
||
| 909 | * the limits of the fast version. |
||
| 910 | */ |
||
| 911 | IPC_SET_ARG5(call->data, 0); |
||
| 1329 | palkovsky | 912 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
| 1040 | palkovsky | 913 | |
| 1027 | palkovsky | 914 | ipc_answer(&TASK->answerbox, call); |
| 1329 | palkovsky | 915 | return rc; |
| 1027 | palkovsky | 916 | } |
| 917 | |||
| 2471 | jermar | 918 | /** Answer an IPC call. |
| 919 | * |
||
| 920 | * @param callid Hash of the call to be answered. |
||
| 921 | * @param data Userspace address of call data with the answer. |
||
| 922 | * |
||
| 923 | * @return Return 0 on success, otherwise return an error code. |
||
| 924 | */ |
||
| 2619 | jermar | 925 | unative_t sys_ipc_answer_slow(unative_t callid, ipc_data_t *data) |
| 1027 | palkovsky | 926 | { |
| 927 | call_t *call; |
||
| 1040 | palkovsky | 928 | ipc_data_t saved_data; |
| 1088 | palkovsky | 929 | int saveddata = 0; |
| 1288 | jermar | 930 | int rc; |
| 1027 | palkovsky | 931 | |
| 1346 | palkovsky | 932 | /* Do not answer notification callids */ |
| 933 | if (callid & IPC_CALLID_NOTIFICATION) |
||
| 934 | return 0; |
||
| 935 | |||
| 1040 | palkovsky | 936 | call = get_call(callid); |
| 937 | if (!call) |
||
| 938 | return ENOENT; |
||
| 1027 | palkovsky | 939 | |
| 1088 | palkovsky | 940 | if (answer_need_old(call)) { |
| 1040 | palkovsky | 941 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
| 1088 | palkovsky | 942 | saveddata = 1; |
| 1027 | palkovsky | 943 | } |
| 1288 | jermar | 944 | rc = copy_from_uspace(&call->data.args, &data->args, |
| 2359 | jermar | 945 | sizeof(call->data.args)); |
| 1288 | jermar | 946 | if (rc != 0) |
| 947 | return rc; |
||
| 1027 | palkovsky | 948 | |
| 1329 | palkovsky | 949 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
| 1027 | palkovsky | 950 | |
| 951 | ipc_answer(&TASK->answerbox, call); |
||
| 952 | |||
| 1329 | palkovsky | 953 | return rc; |
| 1027 | palkovsky | 954 | } |
| 955 | |||
| 2471 | jermar | 956 | /** Hang up a phone. |
| 1086 | palkovsky | 957 | * |
| 2471 | jermar | 958 | * @param Phone handle of the phone to be hung up. |
| 959 | * |
||
| 960 | * @return Return 0 on success or an error code. |
||
| 1086 | palkovsky | 961 | */ |
| 1780 | jermar | 962 | unative_t sys_ipc_hangup(int phoneid) |
| 1086 | palkovsky | 963 | { |
| 964 | phone_t *phone; |
||
| 965 | |||
| 966 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
||
| 967 | |||
| 1591 | palkovsky | 968 | if (ipc_phone_hangup(phone)) |
| 1086 | palkovsky | 969 | return -1; |
| 970 | |||
| 971 | return 0; |
||
| 972 | } |
||
| 973 | |||
| 2471 | jermar | 974 | /** Wait for an incoming IPC call or an answer. |
| 1027 | palkovsky | 975 | * |
| 2359 | jermar | 976 | * @param calldata Pointer to buffer where the call/answer data is stored. |
| 977 | * @param usec Timeout. See waitq_sleep_timeout() for explanation. |
||
| 978 | * @param flags Select mode of sleep operation. See waitq_sleep_timeout() |
||
| 979 | * for explanation. |
||
| 1364 | jermar | 980 | * |
| 2471 | jermar | 981 | * @return Hash of the call. |
| 982 | * If IPC_CALLID_NOTIFICATION bit is set in the hash, the |
||
| 983 | * call is a notification. IPC_CALLID_ANSWERED denotes an |
||
| 984 | * answer. |
||
| 1027 | palkovsky | 985 | */ |
| 1780 | jermar | 986 | unative_t sys_ipc_wait_for_call(ipc_data_t *calldata, uint32_t usec, int flags) |
| 1027 | palkovsky | 987 | { |
| 988 | call_t *call; |
||
| 989 | |||
| 990 | restart: |
||
| 2359 | jermar | 991 | call = ipc_wait_for_call(&TASK->answerbox, usec, |
| 992 | flags | SYNCH_FLAGS_INTERRUPTIBLE); |
||
| 1088 | palkovsky | 993 | if (!call) |
| 994 | return 0; |
||
| 1027 | palkovsky | 995 | |
| 1258 | palkovsky | 996 | if (call->flags & IPC_CALL_NOTIF) { |
| 997 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
||
| 1693 | palkovsky | 998 | |
| 999 | /* Set in_phone_hash to the interrupt counter */ |
||
| 2098 | decky | 1000 | call->data.phone = (void *) call->priv; |
| 1693 | palkovsky | 1001 | |
| 1002 | STRUCT_TO_USPACE(calldata, &call->data); |
||
| 1003 | |||
| 1258 | palkovsky | 1004 | ipc_call_free(call); |
| 1005 | |||
| 2471 | jermar | 1006 | return ((unative_t) call) | IPC_CALLID_NOTIFICATION; |
| 1258 | palkovsky | 1007 | } |
| 1008 | |||
| 1027 | palkovsky | 1009 | if (call->flags & IPC_CALL_ANSWERED) { |
| 1090 | palkovsky | 1010 | process_answer(call); |
| 1027 | palkovsky | 1011 | |
| 1086 | palkovsky | 1012 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
| 1013 | |||
| 1027 | palkovsky | 1014 | atomic_dec(&TASK->active_calls); |
| 1086 | palkovsky | 1015 | |
| 1016 | if (call->flags & IPC_CALL_DISCARD_ANSWER) { |
||
| 1017 | ipc_call_free(call); |
||
| 1018 | goto restart; |
||
| 1019 | } |
||
| 1020 | |||
| 1021 | STRUCT_TO_USPACE(&calldata->args, &call->data.args); |
||
| 1027 | palkovsky | 1022 | ipc_call_free(call); |
| 1023 | |||
| 2471 | jermar | 1024 | return ((unative_t) call) | IPC_CALLID_ANSWERED; |
| 1027 | palkovsky | 1025 | } |
| 1086 | palkovsky | 1026 | |
| 1027 | palkovsky | 1027 | if (process_request(&TASK->answerbox, call)) |
| 1028 | goto restart; |
||
| 1086 | palkovsky | 1029 | |
| 1090 | palkovsky | 1030 | /* Include phone address('id') of the caller in the request, |
| 1031 | * copy whole call->data, not only call->data.args */ |
||
| 1396 | palkovsky | 1032 | if (STRUCT_TO_USPACE(calldata, &call->data)) { |
| 1033 | return 0; |
||
| 1034 | } |
||
| 1780 | jermar | 1035 | return (unative_t)call; |
| 1027 | palkovsky | 1036 | } |
| 1258 | palkovsky | 1037 | |
| 2471 | jermar | 1038 | /** Connect an IRQ handler to a task. |
| 1923 | jermar | 1039 | * |
| 2471 | jermar | 1040 | * @param inr IRQ number. |
| 1041 | * @param devno Device number. |
||
| 1042 | * @param method Method to be associated with the notification. |
||
| 1043 | * @param ucode Uspace pointer to the top-half pseudocode. |
||
| 1923 | jermar | 1044 | * |
| 2471 | jermar | 1045 | * @return EPERM or a return code returned by ipc_irq_register(). |
| 1923 | jermar | 1046 | */ |
| 2359 | jermar | 1047 | unative_t sys_ipc_register_irq(inr_t inr, devno_t devno, unative_t method, |
| 1048 | irq_code_t *ucode) |
||
| 1258 | palkovsky | 1049 | { |
| 1297 | jermar | 1050 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
| 1051 | return EPERM; |
||
| 1052 | |||
| 1923 | jermar | 1053 | return ipc_irq_register(&TASK->answerbox, inr, devno, method, ucode); |
| 1258 | palkovsky | 1054 | } |
| 1055 | |||
| 2471 | jermar | 1056 | /** Disconnect an IRQ handler from a task. |
| 1923 | jermar | 1057 | * |
| 2471 | jermar | 1058 | * @param inr IRQ number. |
| 1059 | * @param devno Device number. |
||
| 1060 | * |
||
| 1061 | * @return Zero on success or EPERM on error.. |
||
| 1923 | jermar | 1062 | */ |
| 1063 | unative_t sys_ipc_unregister_irq(inr_t inr, devno_t devno) |
||
| 1258 | palkovsky | 1064 | { |
| 1297 | jermar | 1065 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
| 1066 | return EPERM; |
||
| 1067 | |||
| 1923 | jermar | 1068 | ipc_irq_unregister(&TASK->answerbox, inr, devno); |
| 1258 | palkovsky | 1069 | |
| 1070 | return 0; |
||
| 1071 | } |
||
| 1702 | cejka | 1072 | |
| 2801 | svoboda | 1073 | #include <console/klog.h> |
| 1074 | |||
| 1075 | /** |
||
| 1076 | * Syscall connect to a task by id. |
||
| 1077 | * |
||
| 1078 | * @return Phone id on success, or negative error code. |
||
| 1079 | */ |
||
| 2808 | svoboda | 1080 | unative_t sys_ipc_connect_kbox(sysarg64_t *uspace_taskid_arg) |
| 2801 | svoboda | 1081 | { |
| 1082 | sysarg64_t taskid_arg; |
||
| 1083 | int rc; |
||
| 1084 | |||
| 1085 | rc = copy_from_uspace(&taskid_arg, uspace_taskid_arg, sizeof(sysarg64_t)); |
||
| 1086 | if (rc != 0) |
||
| 1087 | return (unative_t) rc; |
||
| 1088 | |||
| 1089 | klog_printf("sys_ipc_connect_kbox(%lld, %d)", taskid_arg.value); |
||
| 1090 | |||
| 2808 | svoboda | 1091 | return ipc_connect_kbox(taskid_arg.value); |
| 2801 | svoboda | 1092 | } |
| 1093 | |||
| 1757 | jermar | 1094 | /** @} |
| 1702 | cejka | 1095 | */ |