xnu-4570.1.46.tar.gz

[apple/xnu.git] / osfmk / kperf / arm / kperf_mp.c

diff --git a/osfmk/kperf/arm/kperf_mp.c b/osfmk/kperf/arm/kperf_mp.c
new file mode 100644 (file)
index 0000000..ee29872
--- /dev/null
+++ b/osfmk/kperf/arm/kperf_mp.c
@@ -0,0 +1,100 @@
+/*
+ * Copyright (c) 2011-2016 Apple Computer, Inc. All rights reserved.
+ *
+ * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
+ *
+ * This file contains Original Code and/or Modifications of Original Code
+ * as defined in and that are subject to the Apple Public Source License
+ * Version 2.0 (the 'License'). You may not use this file except in
+ * compliance with the License. The rights granted to you under the License
+ * may not be used to create, or enable the creation or redistribution of,
+ * unlawful or unlicensed copies of an Apple operating system, or to
+ * circumvent, violate, or enable the circumvention or violation of, any
+ * terms of an Apple operating system software license agreement.
+ *
+ * Please obtain a copy of the License at
+ * http://www.opensource.apple.com/apsl/ and read it before using this file.
+ *
+ * The Original Code and all software distributed under the License are
+ * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
+ * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
+ * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
+ * Please see the License for the specific language governing rights and
+ * limitations under the License.
+ *
+ * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
+ */
+
+#include <arm/cpu_internal.h>
+#include <kern/machine.h>
+#include <kern/cpu_number.h>
+#include <kern/kalloc.h>
+#include <kern/processor.h>
+#include <kperf/kperf.h>
+#include <kperf/kperf_arch.h>
+#include <kperf/kperf_timer.h>
+#include <mach/mach_types.h>
+#include <machine/machine_routines.h> /* xcall */
+#include <stdatomic.h>
+
+void
+kperf_signal_handler(unsigned int cpu_number)
+{
+       uint64_t cpu_mask = UINT64_C(1) << cpu_number;
+
+       /* find all the timers that caused a signal */
+       for(int i = 0; i < (int)kperf_timerc; i++) {
+               uint64_t pending_cpus;
+               struct kperf_timer *timer = &kperf_timerv[i];
+
+               pending_cpus = atomic_fetch_and_explicit(&timer->pending_cpus,
+                               ~cpu_mask, memory_order_relaxed);
+               if (pending_cpus & cpu_mask) {
+                       kperf_ipi_handler(timer);
+               }
+       }
+}
+
+bool
+kperf_mp_broadcast_other_running(struct kperf_timer *timer)
+{
+       int current_cpu = cpu_number();
+       bool system_only_self = true;
+       int n_cpus = machine_info.logical_cpu_max;
+
+       /* signal all running processors */
+       for (int i = 0; i < n_cpus; i++) {
+               uint64_t i_bit = UINT64_C(1) << i;
+               processor_t processor = cpu_to_processor(i);
+
+               /* do not IPI processors that are not scheduling threads */
+               if (processor == PROCESSOR_NULL ||
+                               processor->state != PROCESSOR_RUNNING ||
+                               processor->active_thread == THREAD_NULL)
+               {
+                       continue;
+               }
+
+               if (i == current_cpu) {
+                       system_only_self = false;
+                       continue;
+               }
+
+               /* nor processors that have not responded to the last broadcast */
+               uint64_t already_pending = atomic_fetch_or_explicit(
+                               &timer->pending_cpus, i_bit, memory_order_relaxed);
+               if (already_pending & i_bit)
+               {
+#if DEVELOPMENT || DEBUG
+                       atomic_fetch_add_explicit(&kperf_pending_ipis, 1,
+                                       memory_order_relaxed);
+#endif /* DEVELOPMENT || DEBUG */
+                       continue;
+               }
+
+               cpu_signal(cpu_datap(i), SIGPkptimer, NULL, NULL);
+       }
+
+       return system_only_self;
+}