arch_timer.c 962 B

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758
  1. /*
  2. * (C) Copyright 2012-2014
  3. * Texas Instruments Incorporated, <www.ti.com>
  4. *
  5. * SPDX-License-Identifier: GPL-2.0+
  6. */
  7. #include <common.h>
  8. #include <asm/io.h>
  9. #include <div64.h>
  10. DECLARE_GLOBAL_DATA_PTR;
  11. int timer_init(void)
  12. {
  13. gd->arch.tbl = 0;
  14. gd->arch.tbu = 0;
  15. gd->arch.timer_rate_hz = CONFIG_SYS_HZ_CLOCK / CONFIG_SYS_HZ;
  16. return 0;
  17. }
  18. unsigned long long get_ticks(void)
  19. {
  20. ulong nowl, nowu;
  21. asm volatile("mrrc p15, 0, %0, %1, c14" : "=r" (nowl), "=r" (nowu));
  22. gd->arch.tbl = nowl;
  23. gd->arch.tbu = nowu;
  24. return (((unsigned long long)gd->arch.tbu) << 32) | gd->arch.tbl;
  25. }
  26. ulong get_timer(ulong base)
  27. {
  28. return lldiv(get_ticks(), gd->arch.timer_rate_hz) - base;
  29. }
  30. void __udelay(unsigned long usec)
  31. {
  32. unsigned long long endtime;
  33. endtime = lldiv((unsigned long long)usec * gd->arch.timer_rate_hz,
  34. 1000UL);
  35. endtime += get_ticks();
  36. while (get_ticks() < endtime)
  37. ;
  38. }
  39. ulong get_tbclk(void)
  40. {
  41. return gd->arch.timer_rate_hz;
  42. }