arch_timer.c 1.1 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364
  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/global_data.h>
  10. #include <asm/io.h>
  11. #include <div64.h>
  12. #include <bootstage.h>
  13. DECLARE_GLOBAL_DATA_PTR;
  14. #ifndef CONFIG_SYS_HZ_CLOCK
  15. static inline u32 read_cntfrq(void)
  16. {
  17. u32 frq;
  18. asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (frq));
  19. return frq;
  20. }
  21. #endif
  22. int timer_init(void)
  23. {
  24. gd->arch.tbl = 0;
  25. gd->arch.tbu = 0;
  26. #ifdef CONFIG_SYS_HZ_CLOCK
  27. gd->arch.timer_rate_hz = CONFIG_SYS_HZ_CLOCK;
  28. #else
  29. gd->arch.timer_rate_hz = read_cntfrq();
  30. #endif
  31. return 0;
  32. }
  33. unsigned long long get_ticks(void)
  34. {
  35. ulong nowl, nowu;
  36. asm volatile("mrrc p15, 0, %0, %1, c14" : "=r" (nowl), "=r" (nowu));
  37. gd->arch.tbl = nowl;
  38. gd->arch.tbu = nowu;
  39. return (((unsigned long long)gd->arch.tbu) << 32) | gd->arch.tbl;
  40. }
  41. ulong timer_get_boot_us(void)
  42. {
  43. if (!gd->arch.timer_rate_hz)
  44. timer_init();
  45. return lldiv(get_ticks(), gd->arch.timer_rate_hz / 1000000);
  46. }
  47. ulong get_tbclk(void)
  48. {
  49. return gd->arch.timer_rate_hz;
  50. }