source: trunk/kernel/syscalls/sys_get_core_id.c @ 645

Last change on this file since 645 was 639, checked in by alain, 5 years ago

ntroduce three new almos-mkh specific syscalls.

File size: 3.1 KB
Line 
1/*
2 * sys_get_core_id.c - Kernel function implementing the "get_core_id" syscall.
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 <hal_uspace.h>
26#include <hal_vmm.h>
27#include <hal_special.h>
28#include <errno.h>
29#include <core.h>
30#include <thread.h>
31#include <process.h>
32#include <vmm.h>
33#include <printk.h>
34
35#include <syscalls.h>
36
37////////////////////////////////////
38int sys_get_core_id( uint32_t * cxy,
39                     uint32_t * lid )
40{
41        error_t   error;
42    vseg_t  * vseg;
43    uint32_t  k_cxy;
44    uint32_t  k_lid;
45
46    thread_t  * this    = CURRENT_THREAD;
47    process_t * process = this->process;
48
49#if (DEBUG_SYS_GET_CORE_ID || CONFIG_INSTRUMENTATION_SYSCALLS)
50uint64_t     tm_start = hal_get_cycles();
51#endif
52
53#if DEBUG_SYS_GET_CORE_ID
54if( DEBUG_SYS_GET_CORE_ID < tm_start )
55printk("\n[%s] thread[%x,%x] enter / cycle %d\n",
56__FUNCTION__, process->pid, this->trdid, (uint32_t)tm_start );
57#endif
58
59   // check cxy buffer in user space
60    error = vmm_get_vseg( process , (intptr_t)cxy , &vseg );
61
62        if( error )
63        {
64
65#if DEBUG_SYSCALLS_ERROR
66printk("\n[ERROR] in %s : cxy buffer unmapped %x / thread %x / process %x\n",
67__FUNCTION__ , (intptr_t)cxy , this->trdid , process->pid );
68#endif
69        this->errno = EFAULT;
70                return -1;
71        }
72
73    // check lid buffer in user space
74    error = vmm_get_vseg( process , (intptr_t)lid , &vseg );
75
76        if( error )
77        {
78
79#if DEBUG_SYSCALLS_ERROR
80printk("\n[ERROR] in %s : lid buffer unmapped %x / thread %x / process %x\n",
81__FUNCTION__ , (intptr_t)lid , this->trdid , process->pid );
82#endif
83        this->errno = EFAULT;
84                return -1;
85        }
86
87    // get parameters
88        k_cxy = local_cxy;
89        k_lid = this->core->lid;
90
91    // copy to user space
92        hal_copy_to_uspace( cxy,
93                        XPTR( local_cxy , &k_cxy ),
94                        sizeof(uint32_t) );
95
96        hal_copy_to_uspace( lid,
97                        XPTR( local_cxy , &k_lid ),
98                        sizeof(uint32_t) );
99
100#if (DEBUG_SYS_GET_CORE_ID || CONFIG_INSTRUMENTATION_SYSCALLS)
101uint64_t     tm_end = hal_get_cycles();
102#endif
103
104#if DEBUG_SYS_GET_CORE_ID
105if( DEBUG_SYS_GET_CORE_ID < tm_end )
106printk("\n[%s] thread[%x,%x] exit / cycle %d\n",
107__FUNCTION__ , process->pid, this->trdid, (uint32_t)tm_end );
108#endif
109
110#if CONFIG_INSTRUMENTATION_SYSCALLS
111hal_atomic_add( &syscalls_cumul_cost[SYS_GET_CORE_ID] , tm_end - tm_start );
112hal_atomic_add( &syscalls_occurences[SYS_GET_CORE_ID] , 1 );
113#endif
114
115        return 0; 
116
117}  // end sys_get_core()
Note: See TracBrowser for help on using the repository browser.