Rev 1417 | Rev 1434 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 1027 | palkovsky | 1 | /* |
| 2 | * Copyright (C) 2006 Ondrej Palkovsky |
||
| 3 | * All rights reserved. |
||
| 4 | * |
||
| 5 | * Redistribution and use in source and binary forms, with or without |
||
| 6 | * modification, are permitted provided that the following conditions |
||
| 7 | * are met: |
||
| 8 | * |
||
| 9 | * - Redistributions of source code must retain the above copyright |
||
| 10 | * notice, this list of conditions and the following disclaimer. |
||
| 11 | * - Redistributions in binary form must reproduce the above copyright |
||
| 12 | * notice, this list of conditions and the following disclaimer in the |
||
| 13 | * documentation and/or other materials provided with the distribution. |
||
| 14 | * - The name of the author may not be used to endorse or promote products |
||
| 15 | * derived from this software without specific prior written permission. |
||
| 16 | * |
||
| 17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
||
| 18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
||
| 19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
||
| 20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
||
| 21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
||
| 22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
||
| 23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
||
| 24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
||
| 25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
||
| 26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
||
| 27 | */ |
||
| 28 | |||
| 29 | #include <arch.h> |
||
| 30 | #include <proc/task.h> |
||
| 1288 | jermar | 31 | #include <proc/thread.h> |
| 1027 | palkovsky | 32 | #include <errno.h> |
| 33 | #include <memstr.h> |
||
| 34 | #include <debug.h> |
||
| 35 | #include <ipc/ipc.h> |
||
| 36 | #include <ipc/sysipc.h> |
||
| 1281 | palkovsky | 37 | #include <ipc/irq.h> |
| 1072 | palkovsky | 38 | #include <ipc/ipcrsc.h> |
| 1258 | palkovsky | 39 | #include <arch/interrupt.h> |
| 1027 | palkovsky | 40 | #include <print.h> |
| 1288 | jermar | 41 | #include <syscall/copy.h> |
| 1297 | jermar | 42 | #include <security/cap.h> |
| 1329 | palkovsky | 43 | #include <mm/as.h> |
| 1027 | palkovsky | 44 | |
| 1084 | palkovsky | 45 | #define GET_CHECK_PHONE(phone,phoneid,err) { \ |
| 46 | if (phoneid > IPC_MAX_PHONES) { err; } \ |
||
| 47 | phone = &TASK->phones[phoneid]; \ |
||
| 48 | } |
||
| 49 | |||
| 1090 | palkovsky | 50 | #define STRUCT_TO_USPACE(dst,src) copy_to_uspace(dst,src,sizeof(*(src))) |
| 1084 | palkovsky | 51 | |
| 1040 | palkovsky | 52 | /** Return true if the method is a system method */ |
| 53 | static inline int is_system_method(__native method) |
||
| 54 | { |
||
| 55 | if (method <= IPC_M_LAST_SYSTEM) |
||
| 56 | return 1; |
||
| 57 | return 0; |
||
| 58 | } |
||
| 59 | |||
| 60 | /** Return true if the message with this method is forwardable |
||
| 61 | * |
||
| 62 | * - some system messages may be forwarded, for some of them |
||
| 63 | * it is useless |
||
| 64 | */ |
||
| 65 | static inline int is_forwardable(__native method) |
||
| 66 | { |
||
| 1428 | palkovsky | 67 | if (method == IPC_M_PHONE_HUNGUP || method == IPC_M_AS_AREA_SEND \ |
| 68 | || method == IPC_M_AS_AREA_RECV) |
||
| 1086 | palkovsky | 69 | return 0; /* This message is meant only for the receiver */ |
| 1040 | palkovsky | 70 | return 1; |
| 71 | } |
||
| 72 | |||
| 1027 | palkovsky | 73 | /****************************************************/ |
| 74 | /* Functions that preprocess answer before sending |
||
| 75 | * it to the recepient |
||
| 76 | */ |
||
| 77 | |||
| 78 | /** Return true if the caller (ipc_answer) should save |
||
| 1088 | palkovsky | 79 | * the old call contents for answer_preprocess |
| 1027 | palkovsky | 80 | */ |
| 1088 | palkovsky | 81 | static inline int answer_need_old(call_t *call) |
| 1027 | palkovsky | 82 | { |
| 1086 | palkovsky | 83 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) |
| 1027 | palkovsky | 84 | return 1; |
| 1086 | palkovsky | 85 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_ME_TO) |
| 1060 | palkovsky | 86 | return 1; |
| 1359 | jermar | 87 | if (IPC_GET_METHOD(call->data) == IPC_M_AS_AREA_SEND) |
| 1329 | palkovsky | 88 | return 1; |
| 1428 | palkovsky | 89 | if (IPC_GET_METHOD(call->data) == IPC_M_AS_AREA_RECV) |
| 90 | return 1; |
||
| 1027 | palkovsky | 91 | return 0; |
| 92 | } |
||
| 93 | |||
| 1428 | palkovsky | 94 | /** Interpret process answer as control information |
| 95 | * |
||
| 96 | * This function is called directly after sys_ipc_answer |
||
| 97 | */ |
||
| 1329 | palkovsky | 98 | static inline int answer_preprocess(call_t *answer, ipc_data_t *olddata) |
| 1027 | palkovsky | 99 | { |
| 100 | int phoneid; |
||
| 101 | |||
| 1088 | palkovsky | 102 | if (IPC_GET_RETVAL(answer->data) == EHANGUP) { |
| 1141 | palkovsky | 103 | /* In case of forward, hangup the forwared phone, |
| 104 | * not the originator |
||
| 105 | */ |
||
| 106 | spinlock_lock(&answer->data.phone->lock); |
||
| 107 | spinlock_lock(&TASK->answerbox.lock); |
||
| 108 | if (answer->data.phone->callee) { |
||
| 109 | list_remove(&answer->data.phone->list); |
||
| 110 | answer->data.phone->callee = 0; |
||
| 111 | } |
||
| 112 | spinlock_unlock(&TASK->answerbox.lock); |
||
| 113 | spinlock_unlock(&answer->data.phone->lock); |
||
| 1088 | palkovsky | 114 | } |
| 115 | |||
| 116 | if (!olddata) |
||
| 1329 | palkovsky | 117 | return 0; |
| 1088 | palkovsky | 118 | |
| 1086 | palkovsky | 119 | if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_TO_ME) { |
| 1040 | palkovsky | 120 | phoneid = IPC_GET_ARG3(*olddata); |
| 1027 | palkovsky | 121 | if (IPC_GET_RETVAL(answer->data)) { |
| 122 | /* The connection was not accepted */ |
||
| 123 | phone_dealloc(phoneid); |
||
| 1040 | palkovsky | 124 | } else { |
| 1090 | palkovsky | 125 | /* The connection was accepted */ |
| 1040 | palkovsky | 126 | phone_connect(phoneid,&answer->sender->answerbox); |
| 1090 | palkovsky | 127 | /* Set 'phone identification' as arg3 of response */ |
| 128 | IPC_SET_ARG3(answer->data, (__native)&TASK->phones[phoneid]); |
||
| 1027 | palkovsky | 129 | } |
| 1086 | palkovsky | 130 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_ME_TO) { |
| 1060 | palkovsky | 131 | /* If the users accepted call, connect */ |
| 132 | if (!IPC_GET_RETVAL(answer->data)) { |
||
| 133 | ipc_phone_connect((phone_t *)IPC_GET_ARG3(*olddata), |
||
| 134 | &TASK->answerbox); |
||
| 135 | } |
||
| 1359 | jermar | 136 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_AS_AREA_SEND) { |
| 137 | if (!IPC_GET_RETVAL(answer->data)) { /* Accepted, handle as_area receipt */ |
||
| 1413 | jermar | 138 | ipl_t ipl; |
| 139 | as_t *as; |
||
| 140 | |||
| 141 | ipl = interrupts_disable(); |
||
| 142 | spinlock_lock(&answer->sender->lock); |
||
| 143 | as = answer->sender->as; |
||
| 144 | spinlock_unlock(&answer->sender->lock); |
||
| 145 | interrupts_restore(ipl); |
||
| 146 | |||
| 1417 | jermar | 147 | return as_area_share(as, IPC_GET_ARG1(*olddata), IPC_GET_ARG2(*olddata), |
| 1428 | palkovsky | 148 | AS, IPC_GET_ARG1(answer->data), IPC_GET_ARG3(*olddata)); |
| 1329 | palkovsky | 149 | } |
| 1428 | palkovsky | 150 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_AS_AREA_RECV) { |
| 151 | if (!IPC_GET_RETVAL(answer->data)) { |
||
| 152 | ipl_t ipl; |
||
| 153 | as_t *as; |
||
| 154 | |||
| 155 | ipl = interrupts_disable(); |
||
| 156 | spinlock_lock(&answer->sender->lock); |
||
| 157 | as = answer->sender->as; |
||
| 158 | spinlock_unlock(&answer->sender->lock); |
||
| 159 | interrupts_restore(ipl); |
||
| 160 | |||
| 161 | return as_area_share(AS, IPC_GET_ARG1(answer->data), IPC_GET_ARG2(*olddata), |
||
| 162 | as, IPC_GET_ARG1(*olddata), IPC_GET_ARG3(*olddata)); |
||
| 163 | } |
||
| 1027 | palkovsky | 164 | } |
| 1329 | palkovsky | 165 | return 0; |
| 1027 | palkovsky | 166 | } |
| 167 | |||
| 1090 | palkovsky | 168 | /** Called before the request is sent |
| 169 | * |
||
| 170 | * @return 0 - no error, -1 - report error to user |
||
| 171 | */ |
||
| 172 | static int request_preprocess(call_t *call) |
||
| 173 | { |
||
| 174 | int newphid; |
||
| 1329 | palkovsky | 175 | size_t size; |
| 1090 | palkovsky | 176 | |
| 177 | switch (IPC_GET_METHOD(call->data)) { |
||
| 178 | case IPC_M_CONNECT_ME_TO: |
||
| 179 | newphid = phone_alloc(); |
||
| 180 | if (newphid < 0) |
||
| 181 | return ELIMIT; |
||
| 182 | /* Set arg3 for server */ |
||
| 183 | IPC_SET_ARG3(call->data, (__native)&TASK->phones[newphid]); |
||
| 184 | call->flags |= IPC_CALL_CONN_ME_TO; |
||
| 185 | call->private = newphid; |
||
| 186 | break; |
||
| 1359 | jermar | 187 | case IPC_M_AS_AREA_SEND: |
| 1417 | jermar | 188 | size = as_get_size(IPC_GET_ARG1(call->data)); |
| 1329 | palkovsky | 189 | if (!size) { |
| 190 | return EPERM; |
||
| 191 | } |
||
| 1417 | jermar | 192 | IPC_SET_ARG2(call->data, size); |
| 1329 | palkovsky | 193 | break; |
| 1090 | palkovsky | 194 | default: |
| 195 | break; |
||
| 196 | } |
||
| 197 | return 0; |
||
| 198 | } |
||
| 199 | |||
| 1027 | palkovsky | 200 | /****************************************************/ |
| 201 | /* Functions called to process received call/answer |
||
| 202 | * before passing to uspace |
||
| 203 | */ |
||
| 204 | |||
| 205 | /** Do basic kernel processing of received call answer */ |
||
| 1090 | palkovsky | 206 | static void process_answer(call_t *call) |
| 1027 | palkovsky | 207 | { |
| 1088 | palkovsky | 208 | if (IPC_GET_RETVAL(call->data) == EHANGUP && \ |
| 209 | call->flags & IPC_CALL_FORWARDED) |
||
| 210 | IPC_SET_RETVAL(call->data, EFORWARD); |
||
| 1090 | palkovsky | 211 | |
| 212 | if (call->flags & IPC_CALL_CONN_ME_TO) { |
||
| 213 | if (IPC_GET_RETVAL(call->data)) |
||
| 214 | phone_dealloc(call->private); |
||
| 215 | else |
||
| 216 | IPC_SET_ARG3(call->data, call->private); |
||
| 217 | } |
||
| 1027 | palkovsky | 218 | } |
| 219 | |||
| 220 | /** Do basic kernel processing of received call request |
||
| 221 | * |
||
| 222 | * @return 0 - the call should be passed to userspace, 1 - ignore call |
||
| 223 | */ |
||
| 224 | static int process_request(answerbox_t *box,call_t *call) |
||
| 225 | { |
||
| 226 | int phoneid; |
||
| 227 | |||
| 1086 | palkovsky | 228 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) { |
| 1040 | palkovsky | 229 | phoneid = phone_alloc(); |
| 1027 | palkovsky | 230 | if (phoneid < 0) { /* Failed to allocate phone */ |
| 231 | IPC_SET_RETVAL(call->data, ELIMIT); |
||
| 232 | ipc_answer(box,call); |
||
| 233 | return -1; |
||
| 234 | } |
||
| 235 | IPC_SET_ARG3(call->data, phoneid); |
||
| 236 | } |
||
| 237 | return 0; |
||
| 238 | } |
||
| 239 | |||
| 240 | /** Send a call over IPC, wait for reply, return to user |
||
| 241 | * |
||
| 242 | * @return Call identification, returns -1 on fatal error, |
||
| 243 | -2 on 'Too many async request, handle answers first |
||
| 244 | */ |
||
| 245 | __native sys_ipc_call_sync_fast(__native phoneid, __native method, |
||
| 1086 | palkovsky | 246 | __native arg1, ipc_data_t *data) |
| 1027 | palkovsky | 247 | { |
| 248 | call_t call; |
||
| 249 | phone_t *phone; |
||
| 1090 | palkovsky | 250 | int res; |
| 1027 | palkovsky | 251 | |
| 1084 | palkovsky | 252 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
| 1027 | palkovsky | 253 | |
| 1084 | palkovsky | 254 | ipc_call_static_init(&call); |
| 1027 | palkovsky | 255 | IPC_SET_METHOD(call.data, method); |
| 256 | IPC_SET_ARG1(call.data, arg1); |
||
| 257 | |||
| 1090 | palkovsky | 258 | if (!(res=request_preprocess(&call))) { |
| 259 | ipc_call_sync(phone, &call); |
||
| 260 | process_answer(&call); |
||
| 261 | } else |
||
| 262 | IPC_SET_RETVAL(call.data, res); |
||
| 1086 | palkovsky | 263 | STRUCT_TO_USPACE(&data->args, &call.data.args); |
| 1027 | palkovsky | 264 | |
| 265 | return 0; |
||
| 266 | } |
||
| 267 | |||
| 268 | /** Synchronous IPC call allowing to send whole message */ |
||
| 1086 | palkovsky | 269 | __native sys_ipc_call_sync(__native phoneid, ipc_data_t *question, |
| 270 | ipc_data_t *reply) |
||
| 1027 | palkovsky | 271 | { |
| 272 | call_t call; |
||
| 273 | phone_t *phone; |
||
| 1090 | palkovsky | 274 | int res; |
| 1288 | jermar | 275 | int rc; |
| 1027 | palkovsky | 276 | |
| 1084 | palkovsky | 277 | ipc_call_static_init(&call); |
| 1288 | jermar | 278 | rc = copy_from_uspace(&call.data.args, &question->args, sizeof(call.data.args)); |
| 279 | if (rc != 0) |
||
| 280 | return (__native) rc; |
||
| 1040 | palkovsky | 281 | |
| 1084 | palkovsky | 282 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
| 1072 | palkovsky | 283 | |
| 1090 | palkovsky | 284 | if (!(res=request_preprocess(&call))) { |
| 285 | ipc_call_sync(phone, &call); |
||
| 286 | process_answer(&call); |
||
| 287 | } else |
||
| 288 | IPC_SET_RETVAL(call.data, res); |
||
| 1027 | palkovsky | 289 | |
| 1288 | jermar | 290 | rc = STRUCT_TO_USPACE(&reply->args, &call.data.args); |
| 291 | if (rc != 0) |
||
| 292 | return rc; |
||
| 1027 | palkovsky | 293 | |
| 294 | return 0; |
||
| 295 | } |
||
| 296 | |||
| 297 | /** Check that the task did not exceed allowed limit |
||
| 298 | * |
||
| 299 | * @return 0 - Limit OK, -1 - limit exceeded |
||
| 300 | */ |
||
| 301 | static int check_call_limit(void) |
||
| 302 | { |
||
| 303 | if (atomic_preinc(&TASK->active_calls) > IPC_MAX_ASYNC_CALLS) { |
||
| 304 | atomic_dec(&TASK->active_calls); |
||
| 305 | return -1; |
||
| 306 | } |
||
| 307 | return 0; |
||
| 308 | } |
||
| 309 | |||
| 310 | /** Send an asynchronous call over ipc |
||
| 311 | * |
||
| 312 | * @return Call identification, returns -1 on fatal error, |
||
| 313 | -2 on 'Too many async request, handle answers first |
||
| 314 | */ |
||
| 315 | __native sys_ipc_call_async_fast(__native phoneid, __native method, |
||
| 316 | __native arg1, __native arg2) |
||
| 317 | { |
||
| 318 | call_t *call; |
||
| 319 | phone_t *phone; |
||
| 1090 | palkovsky | 320 | int res; |
| 1027 | palkovsky | 321 | |
| 322 | if (check_call_limit()) |
||
| 323 | return IPC_CALLRET_TEMPORARY; |
||
| 324 | |||
| 1090 | palkovsky | 325 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
| 1072 | palkovsky | 326 | |
| 1258 | palkovsky | 327 | call = ipc_call_alloc(0); |
| 1027 | palkovsky | 328 | IPC_SET_METHOD(call->data, method); |
| 329 | IPC_SET_ARG1(call->data, arg1); |
||
| 330 | IPC_SET_ARG2(call->data, arg2); |
||
| 331 | |||
| 1090 | palkovsky | 332 | if (!(res=request_preprocess(call))) |
| 333 | ipc_call(phone, call); |
||
| 334 | else |
||
| 335 | ipc_backsend_err(phone, call, res); |
||
| 1027 | palkovsky | 336 | |
| 337 | return (__native) call; |
||
| 338 | } |
||
| 339 | |||
| 340 | /** Synchronous IPC call allowing to send whole message |
||
| 341 | * |
||
| 342 | * @return The same as sys_ipc_call_async |
||
| 343 | */ |
||
| 1086 | palkovsky | 344 | __native sys_ipc_call_async(__native phoneid, ipc_data_t *data) |
| 1027 | palkovsky | 345 | { |
| 346 | call_t *call; |
||
| 347 | phone_t *phone; |
||
| 1090 | palkovsky | 348 | int res; |
| 1288 | jermar | 349 | int rc; |
| 1027 | palkovsky | 350 | |
| 1072 | palkovsky | 351 | if (check_call_limit()) |
| 352 | return IPC_CALLRET_TEMPORARY; |
||
| 353 | |||
| 1090 | palkovsky | 354 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
| 1027 | palkovsky | 355 | |
| 1258 | palkovsky | 356 | call = ipc_call_alloc(0); |
| 1288 | jermar | 357 | rc = copy_from_uspace(&call->data.args, &data->args, sizeof(call->data.args)); |
| 1293 | palkovsky | 358 | if (rc != 0) { |
| 359 | ipc_call_free(call); |
||
| 1288 | jermar | 360 | return (__native) rc; |
| 1293 | palkovsky | 361 | } |
| 1090 | palkovsky | 362 | if (!(res=request_preprocess(call))) |
| 363 | ipc_call(phone, call); |
||
| 364 | else |
||
| 365 | ipc_backsend_err(phone, call, res); |
||
| 1040 | palkovsky | 366 | |
| 1027 | palkovsky | 367 | return (__native) call; |
| 368 | } |
||
| 369 | |||
| 1040 | palkovsky | 370 | /** Forward received call to another destination |
| 371 | * |
||
| 372 | * The arg1 and arg2 are changed in the forwarded message |
||
| 1060 | palkovsky | 373 | * |
| 374 | * Warning: If implementing non-fast version, make sure that |
||
| 375 | * arg3 is not rewritten for certain system IPC |
||
| 1040 | palkovsky | 376 | */ |
| 377 | __native sys_ipc_forward_fast(__native callid, __native phoneid, |
||
| 378 | __native method, __native arg1) |
||
| 379 | { |
||
| 380 | call_t *call; |
||
| 381 | phone_t *phone; |
||
| 382 | |||
| 383 | call = get_call(callid); |
||
| 384 | if (!call) |
||
| 385 | return ENOENT; |
||
| 386 | |||
| 1088 | palkovsky | 387 | call->flags |= IPC_CALL_FORWARDED; |
| 388 | |||
| 1084 | palkovsky | 389 | GET_CHECK_PHONE(phone, phoneid, { |
| 1040 | palkovsky | 390 | IPC_SET_RETVAL(call->data, EFORWARD); |
| 391 | ipc_answer(&TASK->answerbox, call); |
||
| 392 | return ENOENT; |
||
| 1084 | palkovsky | 393 | }); |
| 1040 | palkovsky | 394 | |
| 395 | if (!is_forwardable(IPC_GET_METHOD(call->data))) { |
||
| 396 | IPC_SET_RETVAL(call->data, EFORWARD); |
||
| 397 | ipc_answer(&TASK->answerbox, call); |
||
| 398 | return EPERM; |
||
| 399 | } |
||
| 400 | |||
| 401 | /* Userspace is not allowed to change method of system methods |
||
| 402 | * on forward, allow changing ARG1 and ARG2 by means of method and arg1 |
||
| 403 | */ |
||
| 404 | if (is_system_method(IPC_GET_METHOD(call->data))) { |
||
| 1090 | palkovsky | 405 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) |
| 406 | phone_dealloc(IPC_GET_ARG3(call->data)); |
||
| 407 | |||
| 1040 | palkovsky | 408 | IPC_SET_ARG1(call->data, method); |
| 409 | IPC_SET_ARG2(call->data, arg1); |
||
| 410 | } else { |
||
| 411 | IPC_SET_METHOD(call->data, method); |
||
| 412 | IPC_SET_ARG1(call->data, arg1); |
||
| 413 | } |
||
| 414 | |||
| 1088 | palkovsky | 415 | return ipc_forward(call, phone, &TASK->answerbox); |
| 1040 | palkovsky | 416 | } |
| 417 | |||
| 1027 | palkovsky | 418 | /** Send IPC answer */ |
| 419 | __native sys_ipc_answer_fast(__native callid, __native retval, |
||
| 420 | __native arg1, __native arg2) |
||
| 421 | { |
||
| 422 | call_t *call; |
||
| 1040 | palkovsky | 423 | ipc_data_t saved_data; |
| 1088 | palkovsky | 424 | int saveddata = 0; |
| 1329 | palkovsky | 425 | int rc; |
| 1027 | palkovsky | 426 | |
| 1346 | palkovsky | 427 | /* Do not answer notification callids */ |
| 428 | if (callid & IPC_CALLID_NOTIFICATION) |
||
| 429 | return 0; |
||
| 430 | |||
| 1040 | palkovsky | 431 | call = get_call(callid); |
| 432 | if (!call) |
||
| 433 | return ENOENT; |
||
| 1027 | palkovsky | 434 | |
| 1088 | palkovsky | 435 | if (answer_need_old(call)) { |
| 1040 | palkovsky | 436 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
| 1088 | palkovsky | 437 | saveddata = 1; |
| 1027 | palkovsky | 438 | } |
| 439 | |||
| 440 | IPC_SET_RETVAL(call->data, retval); |
||
| 441 | IPC_SET_ARG1(call->data, arg1); |
||
| 442 | IPC_SET_ARG2(call->data, arg2); |
||
| 1329 | palkovsky | 443 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
| 1040 | palkovsky | 444 | |
| 1027 | palkovsky | 445 | ipc_answer(&TASK->answerbox, call); |
| 1329 | palkovsky | 446 | return rc; |
| 1027 | palkovsky | 447 | } |
| 448 | |||
| 449 | /** Send IPC answer */ |
||
| 1086 | palkovsky | 450 | __native sys_ipc_answer(__native callid, ipc_data_t *data) |
| 1027 | palkovsky | 451 | { |
| 452 | call_t *call; |
||
| 1040 | palkovsky | 453 | ipc_data_t saved_data; |
| 1088 | palkovsky | 454 | int saveddata = 0; |
| 1288 | jermar | 455 | int rc; |
| 1027 | palkovsky | 456 | |
| 1346 | palkovsky | 457 | /* Do not answer notification callids */ |
| 458 | if (callid & IPC_CALLID_NOTIFICATION) |
||
| 459 | return 0; |
||
| 460 | |||
| 1040 | palkovsky | 461 | call = get_call(callid); |
| 462 | if (!call) |
||
| 463 | return ENOENT; |
||
| 1027 | palkovsky | 464 | |
| 1088 | palkovsky | 465 | if (answer_need_old(call)) { |
| 1040 | palkovsky | 466 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
| 1088 | palkovsky | 467 | saveddata = 1; |
| 1027 | palkovsky | 468 | } |
| 1288 | jermar | 469 | rc = copy_from_uspace(&call->data.args, &data->args, |
| 1086 | palkovsky | 470 | sizeof(call->data.args)); |
| 1288 | jermar | 471 | if (rc != 0) |
| 472 | return rc; |
||
| 1027 | palkovsky | 473 | |
| 1329 | palkovsky | 474 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
| 1027 | palkovsky | 475 | |
| 476 | ipc_answer(&TASK->answerbox, call); |
||
| 477 | |||
| 1329 | palkovsky | 478 | return rc; |
| 1027 | palkovsky | 479 | } |
| 480 | |||
| 1086 | palkovsky | 481 | /** Hang up the phone |
| 482 | * |
||
| 483 | */ |
||
| 484 | __native sys_ipc_hangup(int phoneid) |
||
| 485 | { |
||
| 486 | phone_t *phone; |
||
| 487 | |||
| 488 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
||
| 489 | |||
| 490 | if (ipc_phone_hangup(phone)) |
||
| 491 | return -1; |
||
| 492 | |||
| 493 | return 0; |
||
| 494 | } |
||
| 495 | |||
| 1027 | palkovsky | 496 | /** Wait for incoming ipc call or answer |
| 497 | * |
||
| 1086 | palkovsky | 498 | * @param calldata Pointer to buffer where the call/answer data is stored |
| 1364 | jermar | 499 | * @param usec Timeout. See waitq_sleep_timeout() for explanation. |
| 500 | * @param nonblocking See waitq_sleep_timeout() for explanation. |
||
| 501 | * |
||
| 1027 | palkovsky | 502 | * @return Callid, if callid & 1, then the call is answer |
| 503 | */ |
||
| 1364 | jermar | 504 | __native sys_ipc_wait_for_call(ipc_data_t *calldata, __u32 usec, int nonblocking) |
| 1027 | palkovsky | 505 | { |
| 506 | call_t *call; |
||
| 507 | |||
| 508 | restart: |
||
| 1364 | jermar | 509 | call = ipc_wait_for_call(&TASK->answerbox, usec, nonblocking); |
| 1088 | palkovsky | 510 | if (!call) |
| 511 | return 0; |
||
| 1027 | palkovsky | 512 | |
| 1258 | palkovsky | 513 | if (call->flags & IPC_CALL_NOTIF) { |
| 514 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
||
| 515 | STRUCT_TO_USPACE(&calldata->args, &call->data.args); |
||
| 516 | ipc_call_free(call); |
||
| 517 | |||
| 518 | return ((__native)call) | IPC_CALLID_NOTIFICATION; |
||
| 519 | } |
||
| 520 | |||
| 1027 | palkovsky | 521 | if (call->flags & IPC_CALL_ANSWERED) { |
| 1090 | palkovsky | 522 | process_answer(call); |
| 1027 | palkovsky | 523 | |
| 1086 | palkovsky | 524 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
| 525 | |||
| 1027 | palkovsky | 526 | atomic_dec(&TASK->active_calls); |
| 1086 | palkovsky | 527 | |
| 528 | if (call->flags & IPC_CALL_DISCARD_ANSWER) { |
||
| 529 | ipc_call_free(call); |
||
| 530 | goto restart; |
||
| 531 | } |
||
| 532 | |||
| 533 | STRUCT_TO_USPACE(&calldata->args, &call->data.args); |
||
| 1027 | palkovsky | 534 | ipc_call_free(call); |
| 535 | |||
| 536 | return ((__native)call) | IPC_CALLID_ANSWERED; |
||
| 537 | } |
||
| 1086 | palkovsky | 538 | |
| 1027 | palkovsky | 539 | if (process_request(&TASK->answerbox, call)) |
| 540 | goto restart; |
||
| 1086 | palkovsky | 541 | |
| 1090 | palkovsky | 542 | /* Include phone address('id') of the caller in the request, |
| 543 | * copy whole call->data, not only call->data.args */ |
||
| 1396 | palkovsky | 544 | if (STRUCT_TO_USPACE(calldata, &call->data)) { |
| 545 | return 0; |
||
| 546 | } |
||
| 1027 | palkovsky | 547 | return (__native)call; |
| 548 | } |
||
| 1258 | palkovsky | 549 | |
| 550 | /** Connect irq handler to task */ |
||
| 1281 | palkovsky | 551 | __native sys_ipc_register_irq(__native irq, irq_code_t *ucode) |
| 1258 | palkovsky | 552 | { |
| 1297 | jermar | 553 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
| 554 | return EPERM; |
||
| 555 | |||
| 1258 | palkovsky | 556 | if (irq >= IRQ_COUNT) |
| 1297 | jermar | 557 | return (__native) ELIMIT; |
| 1258 | palkovsky | 558 | |
| 559 | irq_ipc_bind_arch(irq); |
||
| 1281 | palkovsky | 560 | |
| 561 | return ipc_irq_register(&TASK->answerbox, irq, ucode); |
||
| 1258 | palkovsky | 562 | } |
| 563 | |||
| 564 | /* Disconnect irq handler from task */ |
||
| 565 | __native sys_ipc_unregister_irq(__native irq) |
||
| 566 | { |
||
| 1297 | jermar | 567 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
| 568 | return EPERM; |
||
| 569 | |||
| 1258 | palkovsky | 570 | if (irq >= IRQ_COUNT) |
| 1297 | jermar | 571 | return (__native) ELIMIT; |
| 1258 | palkovsky | 572 | |
| 573 | ipc_irq_unregister(&TASK->answerbox, irq); |
||
| 574 | |||
| 575 | return 0; |
||
| 576 | } |