platform/surface: dtx: Fix poll function
[linux-2.6-microblaze.git] / kernel / smp.c
index f472ef6..52bf159 100644 (file)
@@ -211,7 +211,7 @@ static u64 cfd_seq_inc(unsigned int src, unsigned int dst, unsigned int type)
        } while (0)
 
 /* Record current CSD work for current CPU, NULL to erase. */
-static void __csd_lock_record(call_single_data_t *csd)
+static void __csd_lock_record(struct __call_single_data *csd)
 {
        if (!csd) {
                smp_mb(); /* NULL cur_csd after unlock. */
@@ -226,13 +226,13 @@ static void __csd_lock_record(call_single_data_t *csd)
                  /* Or before unlock, as the case may be. */
 }
 
-static __always_inline void csd_lock_record(call_single_data_t *csd)
+static __always_inline void csd_lock_record(struct __call_single_data *csd)
 {
        if (static_branch_unlikely(&csdlock_debug_enabled))
                __csd_lock_record(csd);
 }
 
-static int csd_lock_wait_getcpu(call_single_data_t *csd)
+static int csd_lock_wait_getcpu(struct __call_single_data *csd)
 {
        unsigned int csd_type;
 
@@ -282,7 +282,7 @@ static const char *csd_lock_get_type(unsigned int type)
        return (type >= ARRAY_SIZE(seq_type)) ? "?" : seq_type[type];
 }
 
-static void csd_lock_print_extended(call_single_data_t *csd, int cpu)
+static void csd_lock_print_extended(struct __call_single_data *csd, int cpu)
 {
        struct cfd_seq_local *seq = &per_cpu(cfd_seq_local, cpu);
        unsigned int srccpu = csd->node.src;
@@ -321,7 +321,7 @@ static void csd_lock_print_extended(call_single_data_t *csd, int cpu)
  * the CSD_TYPE_SYNC/ASYNC types provide the destination CPU,
  * so waiting on other types gets much less information.
  */
-static bool csd_lock_wait_toolong(call_single_data_t *csd, u64 ts0, u64 *ts1, int *bug_id)
+static bool csd_lock_wait_toolong(struct __call_single_data *csd, u64 ts0, u64 *ts1, int *bug_id)
 {
        int cpu = -1;
        int cpux;
@@ -387,7 +387,7 @@ static bool csd_lock_wait_toolong(call_single_data_t *csd, u64 ts0, u64 *ts1, in
  * previous function call. For multi-cpu calls its even more interesting
  * as we'll have to ensure no other cpu is observing our csd.
  */
-static void __csd_lock_wait(call_single_data_t *csd)
+static void __csd_lock_wait(struct __call_single_data *csd)
 {
        int bug_id = 0;
        u64 ts0, ts1;
@@ -401,7 +401,7 @@ static void __csd_lock_wait(call_single_data_t *csd)
        smp_acquire__after_ctrl_dep();
 }
 
-static __always_inline void csd_lock_wait(call_single_data_t *csd)
+static __always_inline void csd_lock_wait(struct __call_single_data *csd)
 {
        if (static_branch_unlikely(&csdlock_debug_enabled)) {
                __csd_lock_wait(csd);
@@ -431,17 +431,17 @@ static void __smp_call_single_queue_debug(int cpu, struct llist_node *node)
 #else
 #define cfd_seq_store(var, src, dst, type)
 
-static void csd_lock_record(call_single_data_t *csd)
+static void csd_lock_record(struct __call_single_data *csd)
 {
 }
 
-static __always_inline void csd_lock_wait(call_single_data_t *csd)
+static __always_inline void csd_lock_wait(struct __call_single_data *csd)
 {
        smp_cond_load_acquire(&csd->node.u_flags, !(VAL & CSD_FLAG_LOCK));
 }
 #endif
 
-static __always_inline void csd_lock(call_single_data_t *csd)
+static __always_inline void csd_lock(struct __call_single_data *csd)
 {
        csd_lock_wait(csd);
        csd->node.u_flags |= CSD_FLAG_LOCK;
@@ -454,7 +454,7 @@ static __always_inline void csd_lock(call_single_data_t *csd)
        smp_wmb();
 }
 
-static __always_inline void csd_unlock(call_single_data_t *csd)
+static __always_inline void csd_unlock(struct __call_single_data *csd)
 {
        WARN_ON(!(csd->node.u_flags & CSD_FLAG_LOCK));
 
@@ -501,7 +501,7 @@ void __smp_call_single_queue(int cpu, struct llist_node *node)
  * for execution on the given CPU. data must already have
  * ->func, ->info, and ->flags set.
  */
-static int generic_exec_single(int cpu, call_single_data_t *csd)
+static int generic_exec_single(int cpu, struct __call_single_data *csd)
 {
        if (cpu == smp_processor_id()) {
                smp_call_func_t func = csd->func;
@@ -784,7 +784,7 @@ EXPORT_SYMBOL(smp_call_function_single);
  * NOTE: Be careful, there is unfortunately no current debugging facility to
  * validate the correctness of this serialization.
  */
-int smp_call_function_single_async(int cpu, call_single_data_t *csd)
+int smp_call_function_single_async(int cpu, struct __call_single_data *csd)
 {
        int err = 0;
 
@@ -850,12 +850,28 @@ call:
 }
 EXPORT_SYMBOL_GPL(smp_call_function_any);
 
+/*
+ * Flags to be used as scf_flags argument of smp_call_function_many_cond().
+ *
+ * %SCF_WAIT:          Wait until function execution is completed
+ * %SCF_RUN_LOCAL:     Run also locally if local cpu is set in cpumask
+ */
+#define SCF_WAIT       (1U << 0)
+#define SCF_RUN_LOCAL  (1U << 1)
+
 static void smp_call_function_many_cond(const struct cpumask *mask,
                                        smp_call_func_t func, void *info,
-                                       bool wait, smp_cond_func_t cond_func)
+                                       unsigned int scf_flags,
+                                       smp_cond_func_t cond_func)
 {
+       int cpu, last_cpu, this_cpu = smp_processor_id();
        struct call_function_data *cfd;
-       int cpu, next_cpu, this_cpu = smp_processor_id();
+       bool wait = scf_flags & SCF_WAIT;
+       bool run_remote = false;
+       bool run_local = false;
+       int nr_cpus = 0;
+
+       lockdep_assert_preemption_disabled();
 
        /*
         * Can deadlock when called with interrupts disabled.
@@ -863,8 +879,9 @@ static void smp_call_function_many_cond(const struct cpumask *mask,
         * send smp call function interrupt to this cpu and as such deadlocks
         * can't happen.
         */
-       WARN_ON_ONCE(cpu_online(this_cpu) && irqs_disabled()
-                    && !oops_in_progress && !early_boot_irqs_disabled);
+       if (cpu_online(this_cpu) && !oops_in_progress &&
+           !early_boot_irqs_disabled)
+               lockdep_assert_irqs_enabled();
 
        /*
         * When @wait we can deadlock when we interrupt between llist_add() and
@@ -874,70 +891,75 @@ static void smp_call_function_many_cond(const struct cpumask *mask,
         */
        WARN_ON_ONCE(!in_task());
 
-       /* Try to fastpath.  So, what's a CPU they want? Ignoring this one. */
+       /* Check if we need local execution. */
+       if ((scf_flags & SCF_RUN_LOCAL) && cpumask_test_cpu(this_cpu, mask))
+               run_local = true;
+
+       /* Check if we need remote execution, i.e., any CPU excluding this one. */
        cpu = cpumask_first_and(mask, cpu_online_mask);
        if (cpu == this_cpu)
                cpu = cpumask_next_and(cpu, mask, cpu_online_mask);
+       if (cpu < nr_cpu_ids)
+               run_remote = true;
 
-       /* No online cpus?  We're done. */
-       if (cpu >= nr_cpu_ids)
-               return;
+       if (run_remote) {
+               cfd = this_cpu_ptr(&cfd_data);
+               cpumask_and(cfd->cpumask, mask, cpu_online_mask);
+               __cpumask_clear_cpu(this_cpu, cfd->cpumask);
 
-       /* Do we have another CPU which isn't us? */
-       next_cpu = cpumask_next_and(cpu, mask, cpu_online_mask);
-       if (next_cpu == this_cpu)
-               next_cpu = cpumask_next_and(next_cpu, mask, cpu_online_mask);
-
-       /* Fastpath: do that cpu by itself. */
-       if (next_cpu >= nr_cpu_ids) {
-               if (!cond_func || cond_func(cpu, info))
-                       smp_call_function_single(cpu, func, info, wait);
-               return;
-       }
+               cpumask_clear(cfd->cpumask_ipi);
+               for_each_cpu(cpu, cfd->cpumask) {
+                       struct cfd_percpu *pcpu = per_cpu_ptr(cfd->pcpu, cpu);
+                       call_single_data_t *csd = &pcpu->csd;
 
-       cfd = this_cpu_ptr(&cfd_data);
+                       if (cond_func && !cond_func(cpu, info))
+                               continue;
 
-       cpumask_and(cfd->cpumask, mask, cpu_online_mask);
-       __cpumask_clear_cpu(this_cpu, cfd->cpumask);
+                       csd_lock(csd);
+                       if (wait)
+                               csd->node.u_flags |= CSD_TYPE_SYNC;
+                       csd->func = func;
+                       csd->info = info;
+#ifdef CONFIG_CSD_LOCK_WAIT_DEBUG
+                       csd->node.src = smp_processor_id();
+                       csd->node.dst = cpu;
+#endif
+                       cfd_seq_store(pcpu->seq_queue, this_cpu, cpu, CFD_SEQ_QUEUE);
+                       if (llist_add(&csd->node.llist, &per_cpu(call_single_queue, cpu))) {
+                               __cpumask_set_cpu(cpu, cfd->cpumask_ipi);
+                               nr_cpus++;
+                               last_cpu = cpu;
 
-       /* Some callers race with other cpus changing the passed mask */
-       if (unlikely(!cpumask_weight(cfd->cpumask)))
-               return;
+                               cfd_seq_store(pcpu->seq_ipi, this_cpu, cpu, CFD_SEQ_IPI);
+                       } else {
+                               cfd_seq_store(pcpu->seq_noipi, this_cpu, cpu, CFD_SEQ_NOIPI);
+                       }
+               }
 
-       cpumask_clear(cfd->cpumask_ipi);
-       for_each_cpu(cpu, cfd->cpumask) {
-               struct cfd_percpu *pcpu = per_cpu_ptr(cfd->pcpu, cpu);
-               call_single_data_t *csd = &pcpu->csd;
+               cfd_seq_store(this_cpu_ptr(&cfd_seq_local)->ping, this_cpu, CFD_SEQ_NOCPU, CFD_SEQ_PING);
 
-               if (cond_func && !cond_func(cpu, info))
-                       continue;
+               /*
+                * Choose the most efficient way to send an IPI. Note that the
+                * number of CPUs might be zero due to concurrent changes to the
+                * provided mask.
+                */
+               if (nr_cpus == 1)
+                       send_call_function_single_ipi(last_cpu);
+               else if (likely(nr_cpus > 1))
+                       arch_send_call_function_ipi_mask(cfd->cpumask_ipi);
 
-               csd_lock(csd);
-               if (wait)
-                       csd->node.u_flags |= CSD_TYPE_SYNC;
-               csd->func = func;
-               csd->info = info;
-#ifdef CONFIG_CSD_LOCK_WAIT_DEBUG
-               csd->node.src = smp_processor_id();
-               csd->node.dst = cpu;
-#endif
-               cfd_seq_store(pcpu->seq_queue, this_cpu, cpu, CFD_SEQ_QUEUE);
-               if (llist_add(&csd->node.llist, &per_cpu(call_single_queue, cpu))) {
-                       __cpumask_set_cpu(cpu, cfd->cpumask_ipi);
-                       cfd_seq_store(pcpu->seq_ipi, this_cpu, cpu, CFD_SEQ_IPI);
-               } else {
-                       cfd_seq_store(pcpu->seq_noipi, this_cpu, cpu, CFD_SEQ_NOIPI);
-               }
+               cfd_seq_store(this_cpu_ptr(&cfd_seq_local)->pinged, this_cpu, CFD_SEQ_NOCPU, CFD_SEQ_PINGED);
        }
 
-       /* Send a message to all CPUs in the map */
-       cfd_seq_store(this_cpu_ptr(&cfd_seq_local)->ping, this_cpu,
-                     CFD_SEQ_NOCPU, CFD_SEQ_PING);
-       arch_send_call_function_ipi_mask(cfd->cpumask_ipi);
-       cfd_seq_store(this_cpu_ptr(&cfd_seq_local)->pinged, this_cpu,
-                     CFD_SEQ_NOCPU, CFD_SEQ_PINGED);
+       if (run_local && (!cond_func || cond_func(this_cpu, info))) {
+               unsigned long flags;
 
-       if (wait) {
+               local_irq_save(flags);
+               func(info);
+               local_irq_restore(flags);
+       }
+
+       if (run_remote && wait) {
                for_each_cpu(cpu, cfd->cpumask) {
                        call_single_data_t *csd;
 
@@ -948,12 +970,14 @@ static void smp_call_function_many_cond(const struct cpumask *mask,
 }
 
 /**
- * smp_call_function_many(): Run a function on a set of other CPUs.
+ * smp_call_function_many(): Run a function on a set of CPUs.
  * @mask: The set of cpus to run on (only runs on online subset).
  * @func: The function to run. This must be fast and non-blocking.
  * @info: An arbitrary pointer to pass to the function.
- * @wait: If true, wait (atomically) until function has completed
- *        on other CPUs.
+ * @flags: Bitmask that controls the operation. If %SCF_WAIT is set, wait
+ *        (atomically) until function has completed on other CPUs. If
+ *        %SCF_RUN_LOCAL is set, the function will also be run locally
+ *        if the local CPU is set in the @cpumask.
  *
  * If @wait is true, then returns once @func has returned.
  *
@@ -964,7 +988,7 @@ static void smp_call_function_many_cond(const struct cpumask *mask,
 void smp_call_function_many(const struct cpumask *mask,
                            smp_call_func_t func, void *info, bool wait)
 {
-       smp_call_function_many_cond(mask, func, info, wait, NULL);
+       smp_call_function_many_cond(mask, func, info, wait * SCF_WAIT, NULL);
 }
 EXPORT_SYMBOL(smp_call_function_many);
 
@@ -1075,56 +1099,6 @@ void __init smp_init(void)
        smp_cpus_done(setup_max_cpus);
 }
 
-/*
- * Call a function on all processors.  May be used during early boot while
- * early_boot_irqs_disabled is set.  Use local_irq_save/restore() instead
- * of local_irq_disable/enable().
- */
-void on_each_cpu(smp_call_func_t func, void *info, int wait)
-{
-       unsigned long flags;
-
-       preempt_disable();
-       smp_call_function(func, info, wait);
-       local_irq_save(flags);
-       func(info);
-       local_irq_restore(flags);
-       preempt_enable();
-}
-EXPORT_SYMBOL(on_each_cpu);
-
-/**
- * on_each_cpu_mask(): Run a function on processors specified by
- * cpumask, which may include the local processor.
- * @mask: The set of cpus to run on (only runs on online subset).
- * @func: The function to run. This must be fast and non-blocking.
- * @info: An arbitrary pointer to pass to the function.
- * @wait: If true, wait (atomically) until function has completed
- *        on other CPUs.
- *
- * If @wait is true, then returns once @func has returned.
- *
- * You must not call this function with disabled interrupts or from a
- * hardware interrupt handler or from a bottom half handler.  The
- * exception is that it may be used during early boot while
- * early_boot_irqs_disabled is set.
- */
-void on_each_cpu_mask(const struct cpumask *mask, smp_call_func_t func,
-                       void *info, bool wait)
-{
-       int cpu = get_cpu();
-
-       smp_call_function_many(mask, func, info, wait);
-       if (cpumask_test_cpu(cpu, mask)) {
-               unsigned long flags;
-               local_irq_save(flags);
-               func(info);
-               local_irq_restore(flags);
-       }
-       put_cpu();
-}
-EXPORT_SYMBOL(on_each_cpu_mask);
-
 /*
  * on_each_cpu_cond(): Call a function on each processor for which
  * the supplied function cond_func returns true, optionally waiting
@@ -1150,27 +1124,17 @@ EXPORT_SYMBOL(on_each_cpu_mask);
 void on_each_cpu_cond_mask(smp_cond_func_t cond_func, smp_call_func_t func,
                           void *info, bool wait, const struct cpumask *mask)
 {
-       int cpu = get_cpu();
+       unsigned int scf_flags = SCF_RUN_LOCAL;
 
-       smp_call_function_many_cond(mask, func, info, wait, cond_func);
-       if (cpumask_test_cpu(cpu, mask) && cond_func(cpu, info)) {
-               unsigned long flags;
+       if (wait)
+               scf_flags |= SCF_WAIT;
 
-               local_irq_save(flags);
-               func(info);
-               local_irq_restore(flags);
-       }
-       put_cpu();
+       preempt_disable();
+       smp_call_function_many_cond(mask, func, info, scf_flags, cond_func);
+       preempt_enable();
 }
 EXPORT_SYMBOL(on_each_cpu_cond_mask);
 
-void on_each_cpu_cond(smp_cond_func_t cond_func, smp_call_func_t func,
-                     void *info, bool wait)
-{
-       on_each_cpu_cond_mask(cond_func, func, info, wait, cpu_online_mask);
-}
-EXPORT_SYMBOL(on_each_cpu_cond);
-
 static void do_nothing(void *unused)
 {
 }