lib/libthr/thread/thr_affinity.c

   1 /*
   2  * Copyright (c) 2008, David Xu <davidxu@freebsd.org>
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice unmodified, this list of conditions, and the following
  10  *    disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25  *
  26  * $FreeBSD$
  27  *
  28  */
  29
  30 #include "namespace.h"
  31 #include <pthread_np.h>
  32 #include <sys/param.h>
  33 #include <sys/cpuset.h>
  34 #include "un-namespace.h"
  35
  36 #include "thr_private.h"
  37
  38 __weak_reference(_pthread_getaffinity_np, pthread_getaffinity_np);
  39 __weak_reference(_pthread_setaffinity_np, pthread_setaffinity_np);
  40
  41 int
  42 _pthread_setaffinity_np(pthread_t td, size_t cpusetsize, const cpuset_t *cpusetp)
  43 {
  44         struct pthread  *curthread = _get_curthread();
  45         lwpid_t         tid;
  46         int             error;
  47
  48         if (td == curthread) {
  49                 error = cpuset_setaffinity(CPU_LEVEL_WHICH, CPU_WHICH_TID,
  50                         -1, cpusetsize, cpusetp);
  51                 if (error == -1)
  52                         error = errno;
  53         } else if ((error = _thr_find_thread(curthread, td, 0)) == 0) {
  54                 tid = TID(td);
  55                 error = cpuset_setaffinity(CPU_LEVEL_WHICH, CPU_WHICH_TID, tid,
  56                         cpusetsize, cpusetp);
  57                 if (error == -1)
  58                         error = errno;
  59                 THR_THREAD_UNLOCK(curthread, td);
  60         }
  61         return (error);
  62 }
  63
  64 int
  65 _pthread_getaffinity_np(pthread_t td, size_t cpusetsize, cpuset_t *cpusetp)
  66 {
  67         struct pthread  *curthread = _get_curthread();
  68         lwpid_t tid;
  69         int error;
  70
  71         if (td == curthread) {
  72                 error = cpuset_getaffinity(CPU_LEVEL_WHICH, CPU_WHICH_TID,
  73                         -1, cpusetsize, cpusetp);
  74                 if (error == -1)
  75                         error = errno;
  76         } else if ((error = _thr_find_thread(curthread, td, 0)) == 0) {
  77                 tid = TID(td);
  78                 error = cpuset_getaffinity(CPU_LEVEL_WHICH, CPU_WHICH_TID, tid,
  79                             cpusetsize, cpusetp);
  80                 if (error == -1)
  81                         error = errno;
  82                 THR_THREAD_UNLOCK(curthread, td);
  83         }
  84         return (error);
  85 }