cpuset.c revision 1.10.2.2
1 1.10.2.2 wrstuden /* $NetBSD: cpuset.c,v 1.10.2.2 2008/06/24 04:47:49 wrstuden Exp $ */ 2 1.10.2.2 wrstuden 3 1.10.2.2 wrstuden /*- 4 1.10.2.2 wrstuden * Copyright (c) 2008 The NetBSD Foundation, Inc. 5 1.10.2.2 wrstuden * All rights reserved. 6 1.10.2.2 wrstuden * 7 1.10.2.2 wrstuden * This code is derived from software contributed to The NetBSD Foundation 8 1.10.2.2 wrstuden * by Christos Zoulas. 9 1.10.2.2 wrstuden * 10 1.10.2.2 wrstuden * Redistribution and use in source and binary forms, with or without 11 1.10.2.2 wrstuden * modification, are permitted provided that the following conditions 12 1.10.2.2 wrstuden * are met: 13 1.10.2.2 wrstuden * 1. Redistributions of source code must retain the above copyright 14 1.10.2.2 wrstuden * notice, this list of conditions and the following disclaimer. 15 1.10.2.2 wrstuden * 2. Redistributions in binary form must reproduce the above copyright 16 1.10.2.2 wrstuden * notice, this list of conditions and the following disclaimer in the 17 1.10.2.2 wrstuden * documentation and/or other materials provided with the distribution. 18 1.10.2.2 wrstuden * 19 1.10.2.2 wrstuden * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 1.10.2.2 wrstuden * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 1.10.2.2 wrstuden * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 1.10.2.2 wrstuden * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 1.10.2.2 wrstuden * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 1.10.2.2 wrstuden * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 1.10.2.2 wrstuden * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 1.10.2.2 wrstuden * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 1.10.2.2 wrstuden * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 1.10.2.2 wrstuden * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 1.10.2.2 wrstuden * POSSIBILITY OF SUCH DAMAGE. 30 1.10.2.2 wrstuden */ 31 1.10.2.2 wrstuden 32 1.10.2.2 wrstuden #include <sys/cdefs.h> 33 1.10.2.2 wrstuden #if defined(LIBC_SCCS) && !defined(lint) 34 1.10.2.2 wrstuden __RCSID("$NetBSD: cpuset.c,v 1.10.2.2 2008/06/24 04:47:49 wrstuden Exp $"); 35 1.10.2.2 wrstuden #endif /* LIBC_SCCS and not lint */ 36 1.10.2.2 wrstuden 37 1.10.2.2 wrstuden #include <sys/param.h> 38 1.10.2.2 wrstuden #include <sys/sched.h> 39 1.10.2.2 wrstuden #ifdef _KERNEL 40 1.10.2.2 wrstuden #include <sys/kmem.h> 41 1.10.2.2 wrstuden #include <lib/libkern/libkern.h> 42 1.10.2.2 wrstuden #include <sys/atomic.h> 43 1.10.2.2 wrstuden #else 44 1.10.2.2 wrstuden #include <string.h> 45 1.10.2.2 wrstuden #include <stdlib.h> 46 1.10.2.2 wrstuden #include <sys/sysctl.h> 47 1.10.2.2 wrstuden #endif 48 1.10.2.2 wrstuden 49 1.10.2.2 wrstuden #define CPUSET_SHIFT 5 50 1.10.2.2 wrstuden #define CPUSET_MASK 31 51 1.10.2.2 wrstuden #define CPUSET_SIZE(nc) ((nc) > 32 ? ((nc) >> CPUSET_SHIFT) : 1) 52 1.10.2.2 wrstuden 53 1.10.2.2 wrstuden struct _cpuset { 54 1.10.2.2 wrstuden size_t size; 55 1.10.2.2 wrstuden unsigned int nused; 56 1.10.2.2 wrstuden struct _cpuset *next; 57 1.10.2.2 wrstuden uint32_t bits[0]; 58 1.10.2.2 wrstuden }; 59 1.10.2.2 wrstuden 60 1.10.2.2 wrstuden size_t 61 1.10.2.2 wrstuden _cpuset_size(const cpuset_t *c) 62 1.10.2.2 wrstuden { 63 1.10.2.2 wrstuden return sizeof(struct { 64 1.10.2.2 wrstuden size_t size; 65 1.10.2.2 wrstuden unsigned int nused; 66 1.10.2.2 wrstuden struct _cpuset *next; 67 1.10.2.2 wrstuden uint32_t bits[c->size]; 68 1.10.2.2 wrstuden }); 69 1.10.2.2 wrstuden } 70 1.10.2.2 wrstuden 71 1.10.2.2 wrstuden void 72 1.10.2.2 wrstuden _cpuset_zero(cpuset_t *c) 73 1.10.2.2 wrstuden { 74 1.10.2.2 wrstuden #ifdef _KERNEL 75 1.10.2.2 wrstuden KASSERT(c->nused == 1); 76 1.10.2.2 wrstuden #endif 77 1.10.2.2 wrstuden (void)memset(c->bits, 0, c->size * sizeof(c->bits[0])); 78 1.10.2.2 wrstuden } 79 1.10.2.2 wrstuden 80 1.10.2.2 wrstuden int 81 1.10.2.2 wrstuden _cpuset_isset(const cpuset_t *c, int i) 82 1.10.2.2 wrstuden { 83 1.10.2.2 wrstuden int j = i >> CPUSET_SHIFT; 84 1.10.2.2 wrstuden if (j >= c->size || j < 0) 85 1.10.2.2 wrstuden return -1; 86 1.10.2.2 wrstuden return ((1 << (i & CPUSET_MASK)) & c->bits[j]) != 0; 87 1.10.2.2 wrstuden } 88 1.10.2.2 wrstuden 89 1.10.2.2 wrstuden int 90 1.10.2.2 wrstuden _cpuset_set(cpuset_t *c, int i) 91 1.10.2.2 wrstuden { 92 1.10.2.2 wrstuden int j = i >> CPUSET_SHIFT; 93 1.10.2.2 wrstuden if (j >= c->size || j < 0) 94 1.10.2.2 wrstuden return -1; 95 1.10.2.2 wrstuden c->bits[j] |= 1 << (i & CPUSET_MASK); 96 1.10.2.2 wrstuden return 0; 97 1.10.2.2 wrstuden } 98 1.10.2.2 wrstuden 99 1.10.2.2 wrstuden int 100 1.10.2.2 wrstuden _cpuset_clr(cpuset_t *c, int i) 101 1.10.2.2 wrstuden { 102 1.10.2.2 wrstuden int j = i >> CPUSET_SHIFT; 103 1.10.2.2 wrstuden if (j >= c->size || j < 0) 104 1.10.2.2 wrstuden return -1; 105 1.10.2.2 wrstuden c->bits[j] &= ~(1 << (i & CPUSET_MASK)); 106 1.10.2.2 wrstuden return 0; 107 1.10.2.2 wrstuden } 108 1.10.2.2 wrstuden 109 1.10.2.2 wrstuden cpuset_t * 110 1.10.2.2 wrstuden _cpuset_create(void) 111 1.10.2.2 wrstuden { 112 1.10.2.2 wrstuden cpuset_t s, *c; 113 1.10.2.2 wrstuden #ifdef _KERNEL 114 1.10.2.2 wrstuden s.size = CPUSET_SIZE(MAXCPUS); 115 1.10.2.2 wrstuden c = kmem_zalloc(_cpuset_size(&s), KM_SLEEP); 116 1.10.2.2 wrstuden #else 117 1.10.2.2 wrstuden static int mib[2] = { CTL_HW, HW_NCPU }; 118 1.10.2.2 wrstuden int nc; 119 1.10.2.2 wrstuden if (sysctl(mib, __arraycount(mib), &nc, sizeof(nc), NULL, 0) == -1) 120 1.10.2.2 wrstuden return NULL; 121 1.10.2.2 wrstuden s.size = CPUSET_SIZE(nc); 122 1.10.2.2 wrstuden c = calloc(1, _cpuset_size(&s)); 123 1.10.2.2 wrstuden #endif 124 1.10.2.2 wrstuden c->next = NULL; 125 1.10.2.2 wrstuden c->nused = 1; 126 1.10.2.2 wrstuden c->size = s.size; 127 1.10.2.2 wrstuden return c; 128 1.10.2.2 wrstuden } 129 1.10.2.2 wrstuden 130 1.10.2.2 wrstuden void 131 1.10.2.2 wrstuden _cpuset_destroy(cpuset_t *c) 132 1.10.2.2 wrstuden { 133 1.10.2.2 wrstuden #ifdef _KERNEL 134 1.10.2.2 wrstuden while (c) { 135 1.10.2.2 wrstuden KASSERT(c->nused == 0); 136 1.10.2.2 wrstuden kmem_free(c, _cpuset_size(c)); 137 1.10.2.2 wrstuden c = c->next; 138 1.10.2.2 wrstuden } 139 1.10.2.2 wrstuden #else 140 1.10.2.2 wrstuden free(c); 141 1.10.2.2 wrstuden #endif 142 1.10.2.2 wrstuden } 143 1.10.2.2 wrstuden 144 1.10.2.2 wrstuden #ifdef _KERNEL 145 1.10.2.2 wrstuden size_t 146 1.10.2.2 wrstuden _cpuset_nused(const cpuset_t *c) 147 1.10.2.2 wrstuden { 148 1.10.2.2 wrstuden return c->nused; 149 1.10.2.2 wrstuden } 150 1.10.2.2 wrstuden 151 1.10.2.2 wrstuden void 152 1.10.2.2 wrstuden _cpuset_copy(cpuset_t *d, const cpuset_t *s) 153 1.10.2.2 wrstuden { 154 1.10.2.2 wrstuden KASSERT(d->size == s->size); 155 1.10.2.2 wrstuden KASSERT(d->nused == 1); 156 1.10.2.2 wrstuden (void)memcpy(d->bits, s->bits, d->size * sizeof(d->bits[0])); 157 1.10.2.2 wrstuden } 158 1.10.2.2 wrstuden 159 1.10.2.2 wrstuden void 160 1.10.2.2 wrstuden _cpuset_use(cpuset_t *c) 161 1.10.2.2 wrstuden { 162 1.10.2.2 wrstuden atomic_inc_uint(&c->nused); 163 1.10.2.2 wrstuden } 164 1.10.2.2 wrstuden 165 1.10.2.2 wrstuden void 166 1.10.2.2 wrstuden _cpuset_unuse(cpuset_t *c, cpuset_t **lst) 167 1.10.2.2 wrstuden { 168 1.10.2.2 wrstuden if (atomic_dec_uint_nv(&c->nused) != 0) 169 1.10.2.2 wrstuden return; 170 1.10.2.2 wrstuden KASSERT(c->nused > 0); 171 1.10.2.2 wrstuden KASSERT(c->next == NULL); 172 1.10.2.2 wrstuden if (lst == NULL) { 173 1.10.2.2 wrstuden _cpuset_destroy(c); 174 1.10.2.2 wrstuden return; 175 1.10.2.2 wrstuden } 176 1.10.2.2 wrstuden c->next = *lst; 177 1.10.2.2 wrstuden *lst = c; 178 1.10.2.2 wrstuden } 179 1.10.2.2 wrstuden #endif 180
Indexes created Tue Sep 30 20:09:53 GMT 2025