blob: 5fa6a555b35cd56fbbe309042b0d7c038edbd1e3 [file] [log] [blame]
Stephen Warrenae278a92012-11-19 16:41:20 -07001/*
2 * Copyright (c) 2012, NVIDIA CORPORATION. All rights reserved.
3 *
4 * This program is free software; you can redistribute it and/or modify it
5 * under the terms and conditions of the GNU General Public License,
6 * version 2, as published by the Free Software Foundation.
7 *
8 * This program is distributed in the hope it will be useful, but WITHOUT
9 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
10 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
11 * more details.
12 *
13 * You should have received a copy of the GNU General Public License
14 * along with this program. If not, see <http://www.gnu.org/licenses/>.
15 */
16
Marc Zyngierc625f762015-09-28 15:49:15 +010017#include <linux/acpi.h>
Stephen Warrenae278a92012-11-19 16:41:20 -070018#include <linux/init.h>
19#include <linux/of.h>
Arnd Bergmann3d5a9652013-03-19 15:38:50 +010020#include <linux/clocksource.h>
Stephen Warrenae278a92012-11-19 16:41:20 -070021
22extern struct of_device_id __clksrc_of_table[];
Daniel Lezcanob7c4db82016-05-31 16:25:59 +020023extern struct of_device_id __clksrc_ret_of_table[];
Stephen Warrenae278a92012-11-19 16:41:20 -070024
25static const struct of_device_id __clksrc_of_table_sentinel
26 __used __section(__clksrc_of_table_end);
27
Daniel Lezcanob7c4db82016-05-31 16:25:59 +020028static const struct of_device_id __clksrc_ret_of_table_sentinel
29 __used __section(__clksrc_ret_of_table_end);
30
Marc Zyngier3722ed22015-09-28 15:49:18 +010031void __init clocksource_probe(void)
Stephen Warrenae278a92012-11-19 16:41:20 -070032{
33 struct device_node *np;
34 const struct of_device_id *match;
Rob Herring54196cc2014-05-08 16:09:24 -050035 of_init_fn_1 init_func;
Daniel Lezcanob7c4db82016-05-31 16:25:59 +020036 of_init_fn_1_ret init_func_ret;
Linus Walleijfdca6792013-11-20 09:58:56 +010037 unsigned clocksources = 0;
Daniel Lezcanob7c4db82016-05-31 16:25:59 +020038 int ret;
Stephen Warrenae278a92012-11-19 16:41:20 -070039
40 for_each_matching_node_and_match(np, __clksrc_of_table, &match) {
Sebastian Hesselbartheeb93d02013-09-26 02:08:17 +020041 if (!of_device_is_available(np))
42 continue;
43
Stephen Warrenae278a92012-11-19 16:41:20 -070044 init_func = match->data;
Rob Herringeffbfdd2013-02-06 14:40:22 -060045 init_func(np);
Linus Walleijfdca6792013-11-20 09:58:56 +010046 clocksources++;
Stephen Warrenae278a92012-11-19 16:41:20 -070047 }
Marc Zyngierc625f762015-09-28 15:49:15 +010048
Daniel Lezcanob7c4db82016-05-31 16:25:59 +020049 for_each_matching_node_and_match(np, __clksrc_ret_of_table, &match) {
50 if (!of_device_is_available(np))
51 continue;
52
53 init_func_ret = match->data;
54
55 ret = init_func_ret(np);
56 if (ret) {
57 pr_err("Failed to initialize '%s': %d",
58 of_node_full_name(np), ret);
59 continue;
60 }
61
62 clocksources++;
63 }
64
Marc Zyngierc625f762015-09-28 15:49:15 +010065 clocksources += acpi_probe_device_table(clksrc);
66
Linus Walleijfdca6792013-11-20 09:58:56 +010067 if (!clocksources)
68 pr_crit("%s: no matching clocksources found\n", __func__);
Stephen Warrenae278a92012-11-19 16:41:20 -070069}