sandbox_timer.c 1.5 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (C) 2015 Thomas Chou <thomas@wytron.com.tw>
  4. */
  5. #include <common.h>
  6. #include <dm.h>
  7. #include <errno.h>
  8. #include <timer.h>
  9. #include <os.h>
  10. #define SANDBOX_TIMER_RATE 1000000
  11. /* system timer offset in ms */
  12. static unsigned long sandbox_timer_offset;
  13. void timer_test_add_offset(unsigned long offset)
  14. {
  15. sandbox_timer_offset += offset;
  16. }
  17. u64 notrace timer_early_get_count(void)
  18. {
  19. return os_get_nsec() / 1000 + sandbox_timer_offset * 1000;
  20. }
  21. unsigned long notrace timer_early_get_rate(void)
  22. {
  23. return SANDBOX_TIMER_RATE;
  24. }
  25. static notrace u64 sandbox_timer_get_count(struct udevice *dev)
  26. {
  27. return timer_early_get_count();
  28. }
  29. static int sandbox_timer_probe(struct udevice *dev)
  30. {
  31. struct timer_dev_priv *uc_priv = dev_get_uclass_priv(dev);
  32. if (CONFIG_IS_ENABLED(CPU) &&
  33. dev_read_bool(dev, "sandbox,timebase-frequency-fallback"))
  34. return timer_timebase_fallback(dev);
  35. else if (!uc_priv->clock_rate)
  36. uc_priv->clock_rate = SANDBOX_TIMER_RATE;
  37. return 0;
  38. }
  39. static const struct timer_ops sandbox_timer_ops = {
  40. .get_count = sandbox_timer_get_count,
  41. };
  42. static const struct udevice_id sandbox_timer_ids[] = {
  43. { .compatible = "sandbox,timer" },
  44. { }
  45. };
  46. U_BOOT_DRIVER(sandbox_timer) = {
  47. .name = "sandbox_timer",
  48. .id = UCLASS_TIMER,
  49. .of_match = sandbox_timer_ids,
  50. .probe = sandbox_timer_probe,
  51. .ops = &sandbox_timer_ops,
  52. .flags = DM_FLAG_PRE_RELOC,
  53. };
  54. /* This is here in case we don't have a device tree */
  55. U_BOOT_DRVINFO(sandbox_timer_non_fdt) = {
  56. .name = "sandbox_timer",
  57. };