Commit | Line | Data |
---|---|---|
ae278a93 SW |
1 | /* |
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 | ||
c625f76a | 17 | #include <linux/acpi.h> |
ae278a93 SW |
18 | #include <linux/init.h> |
19 | #include <linux/of.h> | |
3d5a9658 | 20 | #include <linux/clocksource.h> |
ae278a93 SW |
21 | |
22 | extern struct of_device_id __clksrc_of_table[]; | |
b7c4db86 | 23 | extern struct of_device_id __clksrc_ret_of_table[]; |
ae278a93 SW |
24 | |
25 | static const struct of_device_id __clksrc_of_table_sentinel | |
26 | __used __section(__clksrc_of_table_end); | |
27 | ||
b7c4db86 DL |
28 | static const struct of_device_id __clksrc_ret_of_table_sentinel |
29 | __used __section(__clksrc_ret_of_table_end); | |
30 | ||
3722ed23 | 31 | void __init clocksource_probe(void) |
ae278a93 SW |
32 | { |
33 | struct device_node *np; | |
34 | const struct of_device_id *match; | |
54196ccb | 35 | of_init_fn_1 init_func; |
b7c4db86 | 36 | of_init_fn_1_ret init_func_ret; |
fdca679d | 37 | unsigned clocksources = 0; |
b7c4db86 | 38 | int ret; |
ae278a93 SW |
39 | |
40 | for_each_matching_node_and_match(np, __clksrc_of_table, &match) { | |
eeb93d02 SH |
41 | if (!of_device_is_available(np)) |
42 | continue; | |
43 | ||
ae278a93 | 44 | init_func = match->data; |
effbfdd7 | 45 | init_func(np); |
fdca679d | 46 | clocksources++; |
ae278a93 | 47 | } |
c625f76a | 48 | |
b7c4db86 DL |
49 | 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 | ||
c625f76a MZ |
65 | clocksources += acpi_probe_device_table(clksrc); |
66 | ||
fdca679d LW |
67 | if (!clocksources) |
68 | pr_crit("%s: no matching clocksources found\n", __func__); | |
ae278a93 | 69 | } |