clkevt-probe.c 1.5 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556
  1. /*
  2. * Copyright (c) 2016, Linaro Ltd. All rights reserved.
  3. * Daniel Lezcano <daniel.lezcano@linaro.org>
  4. *
  5. * This program is free software; you can redistribute it and/or modify it
  6. * under the terms and conditions of the GNU General Public License,
  7. * version 2, as published by the Free Software Foundation.
  8. *
  9. * This program is distributed in the hope it will be useful, but WITHOUT
  10. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12. * more details.
  13. *
  14. * You should have received a copy of the GNU General Public License
  15. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  16. */
  17. #include <linux/init.h>
  18. #include <linux/of.h>
  19. #include <linux/clockchips.h>
  20. extern struct of_device_id __clkevt_of_table[];
  21. static const struct of_device_id __clkevt_of_table_sentinel
  22. __used __section(__clkevt_of_table_end);
  23. int __init clockevent_probe(void)
  24. {
  25. struct device_node *np;
  26. const struct of_device_id *match;
  27. of_init_fn_1_ret init_func;
  28. int ret, clockevents = 0;
  29. for_each_matching_node_and_match(np, __clkevt_of_table, &match) {
  30. if (!of_device_is_available(np))
  31. continue;
  32. init_func = match->data;
  33. ret = init_func(np);
  34. if (ret) {
  35. pr_warn("Failed to initialize '%s' (%d)\n",
  36. np->name, ret);
  37. continue;
  38. }
  39. clockevents++;
  40. }
  41. if (!clockevents) {
  42. pr_crit("%s: no matching clockevent found\n", __func__);
  43. return -ENODEV;
  44. }
  45. return 0;
  46. }