arch_timer.c 1.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2012-2014
  4. * Texas Instruments Incorporated, <www.ti.com>
  5. */
  6. #include <common.h>
  7. #include <init.h>
  8. #include <time.h>
  9. #include <asm/io.h>
  10. #include <div64.h>
  11. #include <bootstage.h>
  12. DECLARE_GLOBAL_DATA_PTR;
  13. #ifndef CONFIG_SYS_HZ_CLOCK
  14. static inline u32 read_cntfrq(void)
  15. {
  16. u32 frq;
  17. asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (frq));
  18. return frq;
  19. }
  20. #endif
  21. int timer_init(void)
  22. {
  23. gd->arch.tbl = 0;
  24. gd->arch.tbu = 0;
  25. #ifdef CONFIG_SYS_HZ_CLOCK
  26. gd->arch.timer_rate_hz = CONFIG_SYS_HZ_CLOCK;
  27. #else
  28. gd->arch.timer_rate_hz = read_cntfrq();
  29. #endif
  30. return 0;
  31. }
  32. unsigned long long get_ticks(void)
  33. {
  34. ulong nowl, nowu;
  35. asm volatile("mrrc p15, 0, %0, %1, c14" : "=r" (nowl), "=r" (nowu));
  36. gd->arch.tbl = nowl;
  37. gd->arch.tbu = nowu;
  38. return (((unsigned long long)gd->arch.tbu) << 32) | gd->arch.tbl;
  39. }
  40. ulong timer_get_boot_us(void)
  41. {
  42. if (!gd->arch.timer_rate_hz)
  43. timer_init();
  44. return lldiv(get_ticks(), gd->arch.timer_rate_hz / 1000000);
  45. }
  46. ulong get_tbclk(void)
  47. {
  48. return gd->arch.timer_rate_hz;
  49. }