1 /* 2 * Copyright (c) 1995-1998 John Birrell <jb@cimlogic.com.au> 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, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. Neither the name of the author nor the names of any co-contributors 14 * may be used to endorse or promote products derived from this software 15 * without specific prior written permission. 16 * 17 * THIS SOFTWARE IS PROVIDED BY JOHN BIRRELL AND CONTRIBUTORS ``AS IS'' AND 18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 27 * SUCH DAMAGE. 28 */ 29 30 #include "namespace.h" 31 #include <sys/types.h> 32 #include <sys/usched.h> 33 #include <errno.h> 34 #include <string.h> 35 #include <pthread.h> 36 #include <pthread_np.h> 37 #include "un-namespace.h" 38 39 #include "thr_private.h" 40 41 int 42 _pthread_getaffinity_np(pthread_t thread, size_t cpusetsize, 43 cpu_set_t *mask) 44 { 45 struct pthread *curthread = tls_get_curthread(); 46 cpu_set_t mask1; 47 int ret; 48 49 if (curthread == thread) { 50 ret = 0; 51 if (lwp_getaffinity(0, thread->tid, &mask1) < 0) 52 ret = errno; 53 } else { 54 ret = ESRCH; 55 if (_thr_ref_add(curthread, thread, 0) == 0) { 56 THR_THREAD_LOCK(curthread, thread); 57 if (thread->state != PS_DEAD) { 58 ret = 0; 59 if (lwp_getaffinity(0, thread->tid, &mask1) < 0) 60 ret = errno; 61 } 62 THR_THREAD_UNLOCK(curthread, thread); 63 _thr_ref_delete(curthread, thread); 64 } 65 } 66 if (ret != 0) 67 return (ret); 68 69 if (cpusetsize > sizeof(mask1)) { 70 memset(mask, 0, cpusetsize); 71 memcpy(mask, &mask1, sizeof(mask1)); 72 } else { 73 memcpy(mask, &mask1, cpusetsize); 74 } 75 return (0); 76 } 77 __strong_reference(_pthread_getaffinity_np, pthread_getaffinity_np); 78 79 int 80 _pthread_setaffinity_np(pthread_t thread, size_t cpusetsize, 81 const cpu_set_t *mask) 82 { 83 struct pthread *curthread = tls_get_curthread(); 84 size_t cplen = cpusetsize; 85 cpu_set_t mask1; 86 int ret; 87 88 if (cplen > sizeof(mask1)) 89 cplen = sizeof(mask1); 90 CPU_ZERO(&mask1); 91 memcpy(&mask1, mask, cplen); 92 93 if (curthread == thread) { 94 ret = 0; 95 if (lwp_setaffinity(0, thread->tid, &mask1) < 0) 96 ret = errno; 97 } else { 98 ret = ESRCH; 99 if (_thr_ref_add(curthread, thread, 0) == 0) { 100 THR_THREAD_LOCK(curthread, thread); 101 if (thread->state != PS_DEAD) { 102 ret = 0; 103 if (lwp_setaffinity(0, thread->tid, &mask1) < 0) 104 ret = errno; 105 } 106 THR_THREAD_UNLOCK(curthread, thread); 107 _thr_ref_delete(curthread, thread); 108 } 109 } 110 return (ret); 111 } 112 __strong_reference(_pthread_setaffinity_np, pthread_setaffinity_np); 113