Add notifier framework

This is loosely based on the Linux notifier framework, but
stripped down to the bare minimum.

Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>

2 files changed, 61 insertions, 0 deletions

diff --git a/lib/Makefile b/lib/Makefile
index c52b06facb..4b1074d2a4 100644
--- a/lib/Makefile
+++ b/lib/Makefile
@@ -26,3 +26,5 @@ obj-$(CONFIG_SIMPLE_READLINE)	+= readline_simple.o
 obj-$(CONFIG_GLOB)		+= fnmatch.o
 obj-$(CONFIG_GENERIC_FIND_NEXT_BIT) += find_next_bit.o
 obj-y			+= glob.o
+obj-y			+= notifier.o
+
diff --git a/lib/notifier.c b/lib/notifier.c
new file mode 100644
index 0000000000..9e8eb4e356
--- /dev/null
+++ b/lib/notifier.c
@@ -0,0 +1,59 @@
+#include <common.h>
+#include <list.h>
+#include <notifier.h>
+
+int notifier_chain_register(struct notifier_head *nh, struct notifier_block *n)
+{
+	list_add_tail(&n->list, &nh->blocks);
+	return 0;
+}
+
+int notifier_chain_unregister(struct notifier_head *nh, struct notifier_block *n)
+{
+	list_del(&n->list);
+	return 0;
+}
+
+int notifier_call_chain(struct notifier_head *nh, unsigned long val, void *v)
+{
+	struct notifier_block *entry;
+
+	list_for_each_entry(entry, &nh->blocks, list)
+		entry->notifier_call(entry, val, v);
+
+	return 0;
+}
+
+/*
+ *	Notifier list for code which wants to be called at clock
+ *	frequency changes.
+ */
+static NOTIFIER_HEAD(clock_notifier_list);
+
+/**
+ *	clock_register_client - register a client notifier
+ *	@nb: notifier block to callback on events
+ */
+int clock_register_client(struct notifier_block *nb)
+{
+	return notifier_chain_register(&clock_notifier_list, nb);
+}
+
+/**
+ *	clock_register_client - unregister a client notifier
+ *	@nb: notifier block to callback on events
+ */
+int clock_unregister_client(struct notifier_block *nb)
+{
+	return notifier_chain_unregister(&clock_notifier_list, nb);
+}
+
+/**
+ * clock_register_client - notify clients of clock frequency changes
+ *
+ */
+int clock_notifier_call_chain(void)
+{
+	return notifier_call_chain(&clock_notifier_list, 0, NULL);
+}
+