lib/cpumask.c

   1 #include <linux/slab.h>
   2 #include <linux/kernel.h>
   3 #include <linux/bitops.h>
   4 #include <linux/cpumask.h>
   5 #include <linux/export.h>
   6 #include <linux/bootmem.h>
   7
   8 /**
   9  * cpumask_next_and - get the next cpu in *src1p & *src2p
  10  * @n: the cpu prior to the place to search (ie. return will be > @n)
  11  * @src1p: the first cpumask pointer
  12  * @src2p: the second cpumask pointer
  13  *
  14  * Returns >= nr_cpu_ids if no further cpus set in both.
  15  */
  16 int cpumask_next_and(int n, const struct cpumask *src1p,
  17                      const struct cpumask *src2p)
  18 {
  19         while ((n = cpumask_next(n, src1p)) < nr_cpu_ids)
  20                 if (cpumask_test_cpu(n, src2p))
  21                         break;
  22         return n;
  23 }
  24 EXPORT_SYMBOL(cpumask_next_and);
  25
  26 /**
  27  * cpumask_any_but - return a "random" in a cpumask, but not this one.
  28  * @mask: the cpumask to search
  29  * @cpu: the cpu to ignore.
  30  *
  31  * Often used to find any cpu but smp_processor_id() in a mask.
  32  * Returns >= nr_cpu_ids if no cpus set.
  33  */
  34 int cpumask_any_but(const struct cpumask *mask, unsigned int cpu)
  35 {
  36         unsigned int i;
  37
  38         cpumask_check(cpu);
  39         for_each_cpu(i, mask)
  40                 if (i != cpu)
  41                         break;
  42         return i;
  43 }
  44
  45 /* These are not inline because of header tangles. */
  46 #ifdef CONFIG_CPUMASK_OFFSTACK
  47 /**
  48  * alloc_cpumask_var_node - allocate a struct cpumask on a given node
  49  * @mask: pointer to cpumask_var_t where the cpumask is returned
  50  * @flags: GFP_ flags
  51  *
  52  * Only defined when CONFIG_CPUMASK_OFFSTACK=y, otherwise is
  53  * a nop returning a constant 1 (in <linux/cpumask.h>)
  54  * Returns TRUE if memory allocation succeeded, FALSE otherwise.
  55  *
  56  * In addition, mask will be NULL if this fails.  Note that gcc is
  57  * usually smart enough to know that mask can never be NULL if
  58  * CONFIG_CPUMASK_OFFSTACK=n, so does code elimination in that case
  59  * too.
  60  */
  61 bool alloc_cpumask_var_node(cpumask_var_t *mask, gfp_t flags, int node)
  62 {
  63         *mask = kmalloc_node(cpumask_size(), flags, node);
  64
  65 #ifdef CONFIG_DEBUG_PER_CPU_MAPS
  66         if (!*mask) {
  67                 printk(KERN_ERR "=> alloc_cpumask_var: failed!\n");
  68                 dump_stack();
  69         }
  70 #endif
  71
  72         return *mask != NULL;
  73 }
  74 EXPORT_SYMBOL(alloc_cpumask_var_node);
  75
  76 bool zalloc_cpumask_var_node(cpumask_var_t *mask, gfp_t flags, int node)
  77 {
  78         return alloc_cpumask_var_node(mask, flags | __GFP_ZERO, node);
  79 }
  80 EXPORT_SYMBOL(zalloc_cpumask_var_node);
  81
  82 /**
  83  * alloc_cpumask_var - allocate a struct cpumask
  84  * @mask: pointer to cpumask_var_t where the cpumask is returned
  85  * @flags: GFP_ flags
  86  *
  87  * Only defined when CONFIG_CPUMASK_OFFSTACK=y, otherwise is
  88  * a nop returning a constant 1 (in <linux/cpumask.h>).
  89  *
  90  * See alloc_cpumask_var_node.
  91  */
  92 bool alloc_cpumask_var(cpumask_var_t *mask, gfp_t flags)
  93 {
  94         return alloc_cpumask_var_node(mask, flags, NUMA_NO_NODE);
  95 }
  96 EXPORT_SYMBOL(alloc_cpumask_var);
  97
  98 bool zalloc_cpumask_var(cpumask_var_t *mask, gfp_t flags)
  99 {
 100         return alloc_cpumask_var(mask, flags | __GFP_ZERO);
 101 }
 102 EXPORT_SYMBOL(zalloc_cpumask_var);
 103
 104 /**
 105  * alloc_bootmem_cpumask_var - allocate a struct cpumask from the bootmem arena.
 106  * @mask: pointer to cpumask_var_t where the cpumask is returned
 107  *
 108  * Only defined when CONFIG_CPUMASK_OFFSTACK=y, otherwise is
 109  * a nop (in <linux/cpumask.h>).
 110  * Either returns an allocated (zero-filled) cpumask, or causes the
 111  * system to panic.
 112  */
 113 void __init alloc_bootmem_cpumask_var(cpumask_var_t *mask)
 114 {
 115         *mask = memblock_virt_alloc(cpumask_size(), 0);
 116 }
 117
 118 /**
 119  * free_cpumask_var - frees memory allocated for a struct cpumask.
 120  * @mask: cpumask to free
 121  *
 122  * This is safe on a NULL mask.
 123  */
 124 void free_cpumask_var(cpumask_var_t mask)
 125 {
 126         kfree(mask);
 127 }
 128 EXPORT_SYMBOL(free_cpumask_var);
 129
 130 /**
 131  * free_bootmem_cpumask_var - frees result of alloc_bootmem_cpumask_var
 132  * @mask: cpumask to free
 133  */
 134 void __init free_bootmem_cpumask_var(cpumask_var_t mask)
 135 {
 136         memblock_free_early(__pa(mask), cpumask_size());
 137 }
 138 #endif
 139
 140 /**
 141  * cpumask_set_cpu_local_first - set i'th cpu with local numa cpu's first
 142  *
 143  * @i: index number
 144  * @numa_node: local numa_node
 145  * @dstp: cpumask with the relevant cpu bit set according to the policy
 146  *
 147  * This function sets the cpumask according to a numa aware policy.
 148  * cpumask could be used as an affinity hint for the IRQ related to a
 149  * queue. When the policy is to spread queues across cores - local cores
 150  * first.
 151  *
 152  * Returns 0 on success, -ENOMEM for no memory, and -EAGAIN when failed to set
 153  * the cpu bit and need to re-call the function.
 154  */
 155 int cpumask_set_cpu_local_first(int i, int numa_node, cpumask_t *dstp)
 156 {
 157         cpumask_var_t mask;
 158         int cpu;
 159         int ret = 0;
 160
 161         if (!zalloc_cpumask_var(&mask, GFP_KERNEL))
 162                 return -ENOMEM;
 163
 164         i %= num_online_cpus();
 165
 166         if (numa_node == -1 || !cpumask_of_node(numa_node)) {
 167                 /* Use all online cpu's for non numa aware system */
 168                 cpumask_copy(mask, cpu_online_mask);
 169         } else {
 170                 int n;
 171
 172                 cpumask_and(mask,
 173                             cpumask_of_node(numa_node), cpu_online_mask);
 174
 175                 n = cpumask_weight(mask);
 176                 if (i >= n) {
 177                         i -= n;
 178
 179                         /* If index > number of local cpu's, mask out local
 180                          * cpu's
 181                          */
 182                         cpumask_andnot(mask, cpu_online_mask, mask);
 183                 }
 184         }
 185
 186         for_each_cpu(cpu, mask) {
 187                 if (--i < 0)
 188                         goto out;
 189         }
 190
 191         ret = -EAGAIN;
 192
 193 out:
 194         free_cpumask_var(mask);
 195
 196         if (!ret)
 197                 cpumask_set_cpu(cpu, dstp);
 198
 199         return ret;
 200 }
 201 EXPORT_SYMBOL(cpumask_set_cpu_local_first);