| 1 | /* |
|---|
| 2 | * kern/sys_thread_migrate.c - calls the scheduler to yield current CPU |
|---|
| 3 | * |
|---|
| 4 | * Copyright (c) 2008,2009,2010,2011,2012 Ghassan Almaless |
|---|
| 5 | * Copyright (c) 2011,2012 UPMC Sorbonne Universites |
|---|
| 6 | * |
|---|
| 7 | * This file is part of ALMOS-kernel. |
|---|
| 8 | * |
|---|
| 9 | * ALMOS-kernel is free software; you can redistribute it and/or modify it |
|---|
| 10 | * under the terms of the GNU General Public License as published by |
|---|
| 11 | * the Free Software Foundation; version 2.0 of the License. |
|---|
| 12 | * |
|---|
| 13 | * ALMOS-kernel is distributed in the hope that it will be useful, but |
|---|
| 14 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
|---|
| 15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
|---|
| 16 | * General Public License for more details. |
|---|
| 17 | * |
|---|
| 18 | * You should have received a copy of the GNU General Public License |
|---|
| 19 | * along with ALMOS-kernel; if not, write to the Free Software Foundation, |
|---|
| 20 | * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
|---|
| 21 | */ |
|---|
| 22 | |
|---|
| 23 | #include <cpu.h> |
|---|
| 24 | #include <thread.h> |
|---|
| 25 | #include <task.h> |
|---|
| 26 | #include <scheduler.h> |
|---|
| 27 | |
|---|
| 28 | #define MAX_CPU_NR (CONFIG_MAX_CLUSTER_NR * CONFIG_MAX_CPU_PER_CLUSTER_NR) |
|---|
| 29 | |
|---|
| 30 | int sys_thread_migrate(pthread_attr_t *thread_attr) |
|---|
| 31 | { |
|---|
| 32 | struct thread_s *this; |
|---|
| 33 | pthread_attr_t attr; |
|---|
| 34 | uint_t mode; |
|---|
| 35 | sint_t cpu_gid; |
|---|
| 36 | error_t err; |
|---|
| 37 | |
|---|
| 38 | this = current_thread; |
|---|
| 39 | |
|---|
| 40 | if(thread_attr == NULL) |
|---|
| 41 | { |
|---|
| 42 | err = EINVAL; |
|---|
| 43 | goto fail_inval; |
|---|
| 44 | } |
|---|
| 45 | |
|---|
| 46 | if(NOT_IN_USPACE((uint_t)thread_attr)) |
|---|
| 47 | { |
|---|
| 48 | err = EPERM; |
|---|
| 49 | goto fail_access; |
|---|
| 50 | } |
|---|
| 51 | |
|---|
| 52 | if((err = cpu_copy_from_uspace(&attr, thread_attr, sizeof(attr)))) |
|---|
| 53 | goto fail_ucopy_attr; |
|---|
| 54 | |
|---|
| 55 | cpu_gid = (sint_t)cpu_get_id(); |
|---|
| 56 | |
|---|
| 57 | if(attr.cpu_gid == cpu_gid) |
|---|
| 58 | { |
|---|
| 59 | thread_migration_disable(this); |
|---|
| 60 | return 0; |
|---|
| 61 | } |
|---|
| 62 | |
|---|
| 63 | if((attr.cpu_gid > 0) && (attr.cpu_gid >= MAX_CPU_NR)) |
|---|
| 64 | { |
|---|
| 65 | err = EINVAL; |
|---|
| 66 | goto fail_attr_inval; |
|---|
| 67 | } |
|---|
| 68 | |
|---|
| 69 | cpu_gid = (attr.cpu_gid < 0) ? -1 : (attr.cpu_gid % arch_onln_cpu_nr()); |
|---|
| 70 | |
|---|
| 71 | if(attr.flags & PT_ATTR_AUTO_MGRT) |
|---|
| 72 | this->info.attr.flags |= PT_ATTR_AUTO_MGRT; |
|---|
| 73 | |
|---|
| 74 | #if CONFIG_SHOW_SYSMGRT_MSG |
|---|
| 75 | printk(INFO, "INFO: %s: pid %d, tid %d (%x), cpu %d: asked to migrate to cpu %d [%u]\n", |
|---|
| 76 | __FUNCTION__, |
|---|
| 77 | this->task->pid, |
|---|
| 78 | this->info.order, |
|---|
| 79 | this, |
|---|
| 80 | cpu_get_id(), |
|---|
| 81 | cpu_gid, |
|---|
| 82 | cpu_time_stamp()); |
|---|
| 83 | #endif |
|---|
| 84 | |
|---|
| 85 | cpu_disable_all_irq(&mode); |
|---|
| 86 | thread_clear_cap_migrate(this); |
|---|
| 87 | cpu_restore_irq(mode); |
|---|
| 88 | |
|---|
| 89 | err = thread_migrate(this, cpu_gid); |
|---|
| 90 | |
|---|
| 91 | /* Reload this pointer */ |
|---|
| 92 | this = current_thread; |
|---|
| 93 | |
|---|
| 94 | cpu_disable_all_irq(&mode); |
|---|
| 95 | thread_set_cap_migrate(this); |
|---|
| 96 | thread_migration_deactivate(this); |
|---|
| 97 | cpu_restore_irq(mode); |
|---|
| 98 | |
|---|
| 99 | #if CONFIG_SHOW_SYSMGRT_MSG |
|---|
| 100 | printk(INFO, "INFO: %s: pid %d, tid %d (%x), cpu %d, err %d, done [%u]\n", |
|---|
| 101 | __FUNCTION__, |
|---|
| 102 | this->task->pid, |
|---|
| 103 | this->info.order, |
|---|
| 104 | current_thread, |
|---|
| 105 | cpu_get_id(), |
|---|
| 106 | err, |
|---|
| 107 | cpu_time_stamp()); |
|---|
| 108 | #endif |
|---|
| 109 | |
|---|
| 110 | fail_attr_inval: |
|---|
| 111 | fail_ucopy_attr: |
|---|
| 112 | fail_access: |
|---|
| 113 | fail_inval: |
|---|
| 114 | this->info.errno = err; |
|---|
| 115 | return (err) ? -1 : 0; |
|---|
| 116 | } |
|---|