kernel: Add routine to walk a wait queue
Adds a routine to safely walk a specified wait queue and invoke a
custom callback function on each waiting thread.
Signed-off-by: Peter Mitsis <peter.mitsis@intel.com>
diff --git a/kernel/sched.c b/kernel/sched.c
index e79cec3..3cc81da 100644
--- a/kernel/sched.c
+++ b/kernel/sched.c
@@ -1913,3 +1913,28 @@
}
return ret;
}
+
+int z_sched_waitq_walk(_wait_q_t *wait_q,
+ int (*func)(struct k_thread *, void *), void *data)
+{
+ struct k_thread *thread;
+ int status = 0;
+
+ LOCKED(&sched_spinlock) {
+ _WAIT_Q_FOR_EACH(wait_q, thread) {
+
+ /*
+ * Invoke the callback function on each waiting thread
+ * for as long as there are both waiting threads AND
+ * it returns 0.
+ */
+
+ status = func(thread, data);
+ if (status != 0) {
+ break;
+ }
+ }
+ }
+
+ return status;
+}
