l4/pkg/uclibc/lib/contrib/uclibc/libc/sysdeps/linux/common/sched_setaffinity.c

   1 /* Copyright (C) 2002, 2003, 2004, 2005, 2006 Free Software Foundation, Inc.
   2    This file is part of the GNU C Library.
   3
   4    The GNU C Library is free software; you can redistribute it and/or
   5    modify it under the terms of the GNU Lesser General Public
   6    License as published by the Free Software Foundation; either
   7    version 2.1 of the License, or (at your option) any later version.
   8
   9    The GNU C Library is distributed in the hope that it will be useful,
  10    but WITHOUT ANY WARRANTY; without even the implied warranty of
  11    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12    Lesser General Public License for more details.
  13
  14    You should have received a copy of the GNU Lesser General Public
  15    License along with the GNU C Library; if not, write to the Free
  16    Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
  17    02111-1307 USA.  */
  18
  19 #include <features.h>
  20 #ifdef __USE_GNU
  21
  22 #include <sched.h>
  23 #include <sys/types.h>
  24 #include <sys/syscall.h>
  25 #include <string.h>
  26 #include <unistd.h>
  27 #include <sys/param.h>
  28 #include <alloca.h>
  29
  30 #if defined __NR_sched_setaffinity
  31
  32 #define __NR___syscall_sched_setaffinity __NR_sched_setaffinity
  33 static __inline__ _syscall3(int, __syscall_sched_setaffinity, __kernel_pid_t, pid,
  34                         size_t, cpusetsize, cpu_set_t *, cpuset)
  35
  36 static size_t __kernel_cpumask_size;
  37
  38 int sched_setaffinity(pid_t pid, size_t cpusetsize, const cpu_set_t *cpuset)
  39 {
  40         size_t cnt;
  41         if (unlikely (__kernel_cpumask_size == 0)) {
  42                 INTERNAL_SYSCALL_DECL (err);
  43                 int res;
  44                 size_t psize = 128;
  45                 void *p = alloca (psize);
  46
  47                 while (res = INTERNAL_SYSCALL (sched_getaffinity, err, 3, getpid (),
  48                                                psize, p),
  49                        INTERNAL_SYSCALL_ERROR_P (res, err)
  50                        && INTERNAL_SYSCALL_ERRNO (res, err) == EINVAL)
  51                         p = extend_alloca (p, psize, 2 * psize);
  52
  53                 if (res == 0 || INTERNAL_SYSCALL_ERROR_P (res, err)) {
  54                         __set_errno (INTERNAL_SYSCALL_ERRNO (res, err));
  55                         return -1;
  56                 }
  57
  58                 __kernel_cpumask_size = res;
  59         }
  60
  61         /* We now know the size of the kernel cpumask_t.  Make sure the user
  62            does not request to set a bit beyond that.  */
  63         for (cnt = __kernel_cpumask_size; cnt < cpusetsize; ++cnt)
  64                 if (((char *) cpuset)[cnt] != '\0') {
  65                         /* Found a nonzero byte.  This means the user request cannot be
  66                            fulfilled.  */
  67                         __set_errno (EINVAL);
  68                         return -1;
  69                 }
  70
  71         return INLINE_SYSCALL (sched_setaffinity, 3, pid, cpusetsize, cpuset);
  72 }
  73 #else
  74 #define ___HAVE_NO_sched_setaffinity
  75 #endif
  76
  77 #if defined ___HAVE_NO_sched_setaffinity && defined __UCLIBC_HAS_STUBS__
  78 int sched_setaffinity(pid_t pid, size_t cpusetsize, const cpu_set_t *cpuset)
  79 {
  80     __set_errno(ENOSYS);
  81     return -1;
  82 }
  83 #endif
  84
  85 #endif /* __USE_GNU */