posix/sched_cpucount.c

   1 /* Copyright (C) 2007 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 <limits.h>
  20 #include <sched.h>
  21
  22
  23 int
  24 __sched_cpucount (size_t setsize, const cpu_set_t *setp)
  25 {
  26   int s = 0;
  27   const __cpu_mask *p = setp->__bits;
  28   const __cpu_mask *end = &setp->__bits[setsize / sizeof (__cpu_mask)];
  29
  30   while (p < end)
  31     {
  32       __cpu_mask l = *p++;
  33
  34 #ifdef POPCNT
  35       s += POPCNT (l);
  36 #else
  37       if (l == 0)
  38         continue;
  39
  40 # if LONG_BIT > 32
  41       l = (l & 0x5555555555555555ul) + ((l >> 1) & 0x5555555555555555ul);
  42       l = (l & 0x3333333333333333ul) + ((l >> 2) & 0x3333333333333333ul);
  43       l = (l & 0x0f0f0f0f0f0f0f0ful) + ((l >> 4) & 0x0f0f0f0f0f0f0f0ful);
  44       l = (l & 0x00ff00ff00ff00fful) + ((l >> 8) & 0x00ff00ff00ff00fful);
  45       l = (l & 0x0000ffff0000fffful) + ((l >> 16) & 0x0000ffff0000fffful);
  46       l = (l & 0x00000000fffffffful) + ((l >> 32) & 0x00000000fffffffful);
  47 # else
  48       l = (l & 0x55555555ul) + ((l >> 1) & 0x55555555ul);
  49       l = (l & 0x33333333ul) + ((l >> 2) & 0x33333333ul);
  50       l = (l & 0x0f0f0f0ful) + ((l >> 4) & 0x0f0f0f0ful);
  51       l = (l & 0x00ff00fful) + ((l >> 8) & 0x00ff00fful);
  52       l = (l & 0x0000fffful) + ((l >> 16) & 0x0000fffful);
  53 # endif
  54
  55       s += l;
  56 #endif
  57     }
  58
  59   return s;
  60 }