1 files changed, 55 insertions, 0 deletions

diff --git a/drivers/clocksource/timer-probe.c b/drivers/clocksource/timer-probe.c
new file mode 100644
index 000000000000..da81e5de74fe
--- /dev/null
+++ b/drivers/clocksource/timer-probe.c
@@ -0,0 +1,55 @@
+/*
+ * Copyright (c) 2012, NVIDIA CORPORATION.  All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms and conditions of the GNU General Public License,
+ * version 2, as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <linux/acpi.h>
+#include <linux/init.h>
+#include <linux/of.h>
+#include <linux/clocksource.h>
+
+extern struct of_device_id __timer_of_table[];
+
+static const struct of_device_id __timer_of_table_sentinel
+        __used __section(__timer_of_table_end);
+
+void __init timer_probe(void)
+{
+        struct device_node *np;
+        const struct of_device_id *match;
+        of_init_fn_1_ret init_func_ret;
+        unsigned timers = 0;
+        int ret;
+
+        for_each_matching_node_and_match(np, __timer_of_table, &match) {
+                if (!of_device_is_available(np))
+                        continue;
+
+                init_func_ret = match->data;
+
+                ret = init_func_ret(np);
+                if (ret) {
+                        pr_err("Failed to initialize '%s': %d\n",
+                               of_node_full_name(np), ret);
+                        continue;
+                }
+
+                timers++;
+        }
+
+        timers += acpi_probe_device_table(timer);
+
+        if (!timers)
+                pr_crit("%s: no matching timers found\n", __func__);
+}