| 1 | /*
|
|---|
| 2 | * sys_thread_wakeup.c - wakeup indicated thread
|
|---|
| 3 | *
|
|---|
| 4 | * Author Alain Greiner (2016,2017,2018,2019)
|
|---|
| 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 | #include <syscalls.h>
|
|---|
| 31 |
|
|---|
| 32 | //////////////////////////////////////
|
|---|
| 33 | int sys_thread_wakeup( trdid_t trdid )
|
|---|
| 34 | {
|
|---|
| 35 | thread_t * this = CURRENT_THREAD;
|
|---|
| 36 | process_t * process = this->process;
|
|---|
| 37 |
|
|---|
| 38 | #if (DEBUG_SYS_THREAD_WAKEUP || CONFIG_INSTRUMENTATION_SYSCALLS)
|
|---|
| 39 | uint64_t tm_start = hal_get_cycles();
|
|---|
| 40 | #endif
|
|---|
| 41 |
|
|---|
| 42 | #if DEBUG_SYS_THREAD_WAKEUP
|
|---|
| 43 | if( DEBUG_SYS_THREAD_WAKEUP < tm_start )
|
|---|
| 44 | printk("\n[%s] thread %x in process enter to activate thread %x / cycle %d\n",
|
|---|
| 45 | __FUNCTION__, this->trdid, process->pid, trdid, (uint32_t)tm_start );
|
|---|
| 46 | #endif
|
|---|
| 47 |
|
|---|
| 48 | // get target thread ltid and cxy
|
|---|
| 49 | ltid_t target_ltid = LTID_FROM_TRDID( trdid );
|
|---|
| 50 | cxy_t target_cxy = CXY_FROM_TRDID( trdid );
|
|---|
| 51 |
|
|---|
| 52 | // check trdid argument
|
|---|
| 53 | if( (target_ltid >= CONFIG_THREADS_MAX_PER_CLUSTER) ||
|
|---|
| 54 | (cluster_is_active( target_cxy ) == false) )
|
|---|
| 55 | {
|
|---|
| 56 |
|
|---|
| 57 | #if DEBUG_SYSCALLS_ERROR
|
|---|
| 58 | printk("\n[ERROR] in %s : thread %x in process %x / illegal trdid argument %x\n",
|
|---|
| 59 | __FUNCTION__, this->trdid, process->pid, trdid );
|
|---|
| 60 | #endif
|
|---|
| 61 | this->errno = EINVAL;
|
|---|
| 62 | return -1;
|
|---|
| 63 | }
|
|---|
| 64 |
|
|---|
| 65 | // get extended pointer on target thread
|
|---|
| 66 | xptr_t thread_xp = thread_get_xptr( process->pid , trdid );
|
|---|
| 67 |
|
|---|
| 68 | if( thread_xp == XPTR_NULL )
|
|---|
| 69 | {
|
|---|
| 70 |
|
|---|
| 71 | #if DEBUG_SYSCALLS_ERROR
|
|---|
| 72 | printk("\n[ERROR] in %s : thread %x in process %x cannot find thread %x/n",
|
|---|
| 73 | __FUNCTION__ , this->trdid, process->pid, trdid );
|
|---|
| 74 | #endif
|
|---|
| 75 | CURRENT_THREAD->errno = EINVAL;
|
|---|
| 76 | return -1;
|
|---|
| 77 | }
|
|---|
| 78 |
|
|---|
| 79 | // unblock target thread
|
|---|
| 80 | thread_unblock( thread_xp , THREAD_BLOCKED_GLOBAL );
|
|---|
| 81 |
|
|---|
| 82 | #if (DEBUG_SYS_THREAD_WAKEUP || CONFIG_INSTRUMENTATION_SYSCALLS)
|
|---|
| 83 | uint64_t tm_end = hal_get_cycles();
|
|---|
| 84 | #endif
|
|---|
| 85 |
|
|---|
| 86 |
|
|---|
| 87 | #if DEBUG_SYS_THREAD_WAKEUP
|
|---|
| 88 | if( DEBUG_SYS_THREAD_WAKEUP < tm_end )
|
|---|
| 89 | printk("\n[%s] thread %x in process %x exit / thread %x activated / cycle %d\n",
|
|---|
| 90 | __FUNCTION__ , this->trdid, process->pid, trdid, (uint32_t)tm_end );
|
|---|
| 91 | #endif
|
|---|
| 92 |
|
|---|
| 93 | #if CONFIG_INSTRUMENTATION_SYSCALLS
|
|---|
| 94 | hal_atomic_add( &syscalls_cumul_cost[SYS_THREAD_WAKEUP] , tm_end - tm_start );
|
|---|
| 95 | hal_atomic_add( &syscalls_occurences[SYS_THREAD_WAKEUP] , 1 );
|
|---|
| 96 | #endif
|
|---|
| 97 |
|
|---|
| 98 | return 0;
|
|---|
| 99 |
|
|---|
| 100 | } // end sys_thread_wakeup()
|
|---|
