source: trunk/kernel/syscalls/sys_thread_wakeup.c

Last change on this file was 683, checked in by alain, 4 years ago

All modifications required to support the <tcp_chat> application
including error recovery in case of packet loss.A

File size: 3.4 KB
Line 
1/*
2 * sys_thread_wakeup.c - unblock indicated thread from the SLEEP condition
3 *
4 * Author    Alain Greiner     (2016,2017,2018,2019,2020)
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#include <syscalls.h>
30
31//////////////////////////////////////
32int sys_thread_wakeup( trdid_t trdid )
33{
34        thread_t  * this    = CURRENT_THREAD;
35    process_t * process = this->process;
36
37#if DEBUG_SYS_THREAD_WAKEUP || DEBUG_SYSCALLS_ERROR || CONFIG_INTRUMENTATION_SYSCALLS
38cycle_t      tm_start = hal_get_cycles();
39#endif
40
41#if DEBUG_SYS_THREAD_WAKEUP
42if( DEBUG_SYS_THREAD_WAKEUP < (uint32_t)tm_start )
43printk("\n[%s] thread[%x,%x] enter to activate thread %x / cycle %d\n",
44__FUNCTION__, process->pid, this->trdid, trdid, (uint32_t)tm_start );
45#endif
46
47    // get target thread ltid and cxy
48    ltid_t   target_ltid = LTID_FROM_TRDID( trdid );
49    cxy_t    target_cxy  = CXY_FROM_TRDID( trdid );
50
51    // check trdid argument
52        if( (target_ltid >= CONFIG_THREADS_MAX_PER_CLUSTER) ||
53        (cluster_is_active( target_cxy ) == false) ) 
54        {
55
56#if DEBUG_SYSCALLS_ERROR
57if( DEBUG_SYSCALLS_ERROR < (uint32_t)tm_start )
58printk("\n[ERROR] in %s : thread[%x,%x] / illegal trdid argument %x\n",
59__FUNCTION__, process->pid, this->trdid, 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
72if( DEBUG_SYSCALLS_ERROR < (uint32_t)tm_start )
73printk("\n[ERROR] in %s : thread[%x,%x] / cannot find thread[%x,%x]\n",
74__FUNCTION__, process->pid, this->trdid, process->pid, trdid );
75#endif
76        CURRENT_THREAD->errno = EINVAL;
77        return -1;
78    }
79
80    // get target thread cluster and local pointer
81    thread_t * tgt_ptr = GET_PTR( thread_xp );
82    cxy_t      tgt_cxy = GET_CXY( thread_xp );
83
84    // get state of the target thread alarm
85    bool_t linked = hal_remote_l32( XPTR( tgt_cxy , &tgt_ptr->alarm.linked ) );
86
87    // delete the alarm if active
88    if( linked ) alarm_stop( thread_xp );
89
90    // unblock target thread
91    thread_unblock( thread_xp , THREAD_BLOCKED_SLEEP );
92
93#if (DEBUG_SYS_THREAD_WAKEUP || CONFIG_INSTRUMENTATION_SYSCALLS)
94uint64_t     tm_end = hal_get_cycles();
95#endif
96
97
98#if DEBUG_SYS_THREAD_WAKEUP
99if( DEBUG_SYS_THREAD_WAKEUP < tm_end )
100printk("\n[%s] thread[%x,%x] exit / thread[%x,%x] activated / cycle %d\n",
101__FUNCTION__ , process->pid, this->trdid, process->pid, trdid, (uint32_t)tm_end );
102#endif
103
104#if CONFIG_INSTRUMENTATION_SYSCALLS
105hal_atomic_add( &syscalls_cumul_cost[SYS_THREAD_WAKEUP] , tm_end - tm_start );
106hal_atomic_add( &syscalls_occurences[SYS_THREAD_WAKEUP] , 1 );
107#endif
108
109    return 0;
110
111}  // end sys_thread_wakeup()
Note: See TracBrowser for help on using the repository browser.