timer.c 2.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (C) 2017 Weidmüller Interface GmbH & Co. KG
  4. * Stefan Herbrechtsmeier <stefan.herbrechtsmeier@weidmueller.com>
  5. *
  6. * Copyright (C) 2012 Michal Simek <monstr@monstr.eu>
  7. * Copyright (C) 2011-2017 Xilinx, Inc. All rights reserved.
  8. *
  9. * (C) Copyright 2008
  10. * Guennadi Liakhovetki, DENX Software Engineering, <lg@denx.de>
  11. *
  12. * (C) Copyright 2004
  13. * Philippe Robin, ARM Ltd. <philippe.robin@arm.com>
  14. *
  15. * (C) Copyright 2002-2004
  16. * Gary Jennejohn, DENX Software Engineering, <gj@denx.de>
  17. *
  18. * (C) Copyright 2003
  19. * Texas Instruments <www.ti.com>
  20. *
  21. * (C) Copyright 2002
  22. * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
  23. * Marius Groeger <mgroeger@sysgo.de>
  24. *
  25. * (C) Copyright 2002
  26. * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
  27. * Alex Zuepke <azu@sysgo.de>
  28. */
  29. #include <clk.h>
  30. #include <common.h>
  31. #include <div64.h>
  32. #include <dm.h>
  33. #include <init.h>
  34. #include <time.h>
  35. #include <malloc.h>
  36. #include <asm/io.h>
  37. #include <asm/arch/hardware.h>
  38. #include <asm/arch/clk.h>
  39. DECLARE_GLOBAL_DATA_PTR;
  40. struct scu_timer {
  41. u32 load; /* Timer Load Register */
  42. u32 counter; /* Timer Counter Register */
  43. u32 control; /* Timer Control Register */
  44. };
  45. static struct scu_timer *timer_base =
  46. (struct scu_timer *)ZYNQ_SCUTIMER_BASEADDR;
  47. #define SCUTIMER_CONTROL_PRESCALER_MASK 0x0000FF00 /* Prescaler */
  48. #define SCUTIMER_CONTROL_PRESCALER_SHIFT 8
  49. #define SCUTIMER_CONTROL_AUTO_RELOAD_MASK 0x00000002 /* Auto-reload */
  50. #define SCUTIMER_CONTROL_ENABLE_MASK 0x00000001 /* Timer enable */
  51. #define TIMER_LOAD_VAL 0xFFFFFFFF
  52. #define TIMER_PRESCALE 255
  53. int timer_init(void)
  54. {
  55. const u32 emask = SCUTIMER_CONTROL_AUTO_RELOAD_MASK |
  56. (TIMER_PRESCALE << SCUTIMER_CONTROL_PRESCALER_SHIFT) |
  57. SCUTIMER_CONTROL_ENABLE_MASK;
  58. struct udevice *dev;
  59. struct clk clk;
  60. int ret;
  61. ret = uclass_get_device_by_driver(UCLASS_CLK,
  62. DM_DRIVER_GET(zynq_clk), &dev);
  63. if (ret)
  64. return ret;
  65. clk.id = cpu_6or4x_clk;
  66. ret = clk_request(dev, &clk);
  67. if (ret < 0)
  68. return ret;
  69. gd->cpu_clk = clk_get_rate(&clk);
  70. clk_free(&clk);
  71. gd->arch.timer_rate_hz = (gd->cpu_clk / 2) / (TIMER_PRESCALE + 1);
  72. /* Load the timer counter register */
  73. writel(0xFFFFFFFF, &timer_base->load);
  74. /*
  75. * Start the A9Timer device
  76. * Enable Auto reload mode, Clear prescaler control bits
  77. * Set prescaler value, Enable the decrementer
  78. */
  79. clrsetbits_le32(&timer_base->control, SCUTIMER_CONTROL_PRESCALER_MASK,
  80. emask);
  81. /* Reset time */
  82. gd->arch.lastinc = readl(&timer_base->counter) /
  83. (gd->arch.timer_rate_hz / CONFIG_SYS_HZ);
  84. gd->arch.tbl = 0;
  85. return 0;
  86. }
  87. /*
  88. * This function is derived from PowerPC code (timebase clock frequency).
  89. * On ARM it returns the number of timer ticks per second.
  90. */
  91. ulong get_tbclk(void)
  92. {
  93. return gd->arch.timer_rate_hz;
  94. }