| 1 | /*
|
|---|
| 2 | * sys_thread_wakeup.c - wakeup all indicated threads
|
|---|
| 3 | *
|
|---|
| 4 | * Author Alain Greiner (2016,2017)
|
|---|
| 5 | *
|
|---|
| 6 | * Copyright (c) UPMC Sorbonne Universites
|
|---|
| 7 | *
|
|---|
| 8 | * This file is part of ALMOS-MKH.
|
|---|
| 9 | *
|
|---|
| 10 | * ALMOS-MKH is free software; you can redistribute it and/or modify it
|
|---|
| 11 | * under the terms of the GNU General Public License as published by
|
|---|
| 12 | * the Free Software Foundation; version 2.0 of the License.
|
|---|
| 13 | *
|
|---|
| 14 | * ALMOS-MKH is distributed in the hope that it will be useful, but
|
|---|
| 15 | * WITHOUT ANY WARRANTY; without even the implied warranty of
|
|---|
| 16 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|---|
| 17 | * General Public License for more details.
|
|---|
| 18 | *
|
|---|
| 19 | * You should have received a copy of the GNU General Public License
|
|---|
| 20 | * along with ALMOS-MKH; if not, write to the Free Software Foundation,
|
|---|
| 21 | * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|---|
| 22 | */
|
|---|
| 23 |
|
|---|
| 24 | #include <hal_kernel_types.h>
|
|---|
| 25 | #include <thread.h>
|
|---|
| 26 | #include <printk.h>
|
|---|
| 27 | #include <process.h>
|
|---|
| 28 | #include <errno.h>
|
|---|
| 29 |
|
|---|
| 30 | //////////////////////////////////////
|
|---|
| 31 | int sys_thread_wakeup( trdid_t trdid )
|
|---|
| 32 | {
|
|---|
| 33 | thread_t * this = CURRENT_THREAD;
|
|---|
| 34 | process_t * process = this->process;
|
|---|
| 35 |
|
|---|
| 36 | #if DEBUG_SYS_THREAD_WAKEUP
|
|---|
| 37 | uint64_t tm_start;
|
|---|
| 38 | uint64_t tm_end;
|
|---|
| 39 | tm_start = hal_get_cycles();
|
|---|
| 40 | if( DEBUG_SYS_THREAD_WAKEUP < tm_start )
|
|---|
| 41 | printk("\n[DBG] %s : thread %x enter / activate thread %x in process %x / cycle %d\n",
|
|---|
| 42 | __FUNCTION__ , this, trdid, this->process->pid, (uint32_t)tm_start );
|
|---|
| 43 | #endif
|
|---|
| 44 |
|
|---|
| 45 | // get target thread ltid and cxy
|
|---|
| 46 | ltid_t target_ltid = LTID_FROM_TRDID( trdid );
|
|---|
| 47 | cxy_t target_cxy = CXY_FROM_TRDID( trdid );
|
|---|
| 48 |
|
|---|
| 49 | // check trdid argument
|
|---|
| 50 | if( (target_ltid >= CONFIG_THREAD_MAX_PER_CLUSTER) || cluster_is_undefined( target_cxy ) )
|
|---|
| 51 | {
|
|---|
| 52 |
|
|---|
| 53 | #if DEBUG_SYSCALLS_ERROR
|
|---|
| 54 | printk("\n[ERROR] in %s : illegal trdid argument %x\n", __FUNCTION__, trdid );
|
|---|
| 55 | #endif
|
|---|
| 56 | this->errno = EINVAL;
|
|---|
| 57 | return -1;
|
|---|
| 58 | }
|
|---|
| 59 |
|
|---|
| 60 | // get extended pointer on target thread
|
|---|
| 61 | xptr_t thread_xp = thread_get_xptr( process->pid , trdid );
|
|---|
| 62 |
|
|---|
| 63 | if( thread_xp == XPTR_NULL )
|
|---|
| 64 | {
|
|---|
| 65 |
|
|---|
| 66 | #if DEBUG_SYSCALLS_ERROR
|
|---|
| 67 | printk("\n[ERROR] in %s : cannot find thread %x in process %x/n",
|
|---|
| 68 | __FUNCTION__ , trdid , this->process->pid );
|
|---|
| 69 | #endif
|
|---|
| 70 | CURRENT_THREAD->errno = EINVAL;
|
|---|
| 71 | return -1;
|
|---|
| 72 | }
|
|---|
| 73 |
|
|---|
| 74 | // unblock target thread
|
|---|
| 75 | thread_unblock( thread_xp , THREAD_BLOCKED_GLOBAL );
|
|---|
| 76 |
|
|---|
| 77 | #if DEBUG_SYS_THREAD_WAKEUP
|
|---|
| 78 | tm_end = hal_get_cycles();
|
|---|
| 79 | if( DEBUG_SYS_THREAD_WAKEUP < tm_end )
|
|---|
| 80 | printk("\n[DBG] %s : thread %x exit / thread %x in process %x activated / cycle %d\n",
|
|---|
| 81 | __FUNCTION__ , this, trdid, this->process->pid, (uint32_t)tm_end );
|
|---|
| 82 | #endif
|
|---|
| 83 |
|
|---|
| 84 | return 0;
|
|---|
| 85 |
|
|---|
| 86 | } // end sys_thread_wakeup()
|
|---|
