sunxi_htimer.c 5.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206
  1. /*
  2. * Copyright (c) 2019-2025 Allwinner Technology Co., Ltd. ALL rights reserved.
  3. *
  4. * Allwinner is a trademark of Allwinner Technology Co.,Ltd., registered in
  5. * the the people's Republic of China and other countries.
  6. * All Allwinner Technology Co.,Ltd. trademarks are used with permission.
  7. *
  8. * DISCLAIMER
  9. * THIRD PARTY LICENCES MAY BE REQUIRED TO IMPLEMENT THE SOLUTION/PRODUCT.
  10. * IF YOU NEED TO INTEGRATE THIRD PARTY’S TECHNOLOGY (SONY, DTS, DOLBY, AVS OR MPEGLA, ETC.)
  11. * IN ALLWINNERS’SDK OR PRODUCTS, YOU SHALL BE SOLELY RESPONSIBLE TO OBTAIN
  12. * ALL APPROPRIATELY REQUIRED THIRD PARTY LICENCES.
  13. * ALLWINNER SHALL HAVE NO WARRANTY, INDEMNITY OR OTHER OBLIGATIONS WITH RESPECT TO MATTERS
  14. * COVERED UNDER ANY REQUIRED THIRD PARTY LICENSE.
  15. * YOU ARE SOLELY RESPONSIBLE FOR YOUR USAGE OF THIRD PARTY’S TECHNOLOGY.
  16. *
  17. *
  18. * THIS SOFTWARE IS PROVIDED BY ALLWINNER"AS IS" AND TO THE MAXIMUM EXTENT
  19. * PERMITTED BY LAW, ALLWINNER EXPRESSLY DISCLAIMS ALL WARRANTIES OF ANY KIND,
  20. * WHETHER EXPRESS, IMPLIED OR STATUTORY, INCLUDING WITHOUT LIMITATION REGARDING
  21. * THE TITLE, NON-INFRINGEMENT, ACCURACY, CONDITION, COMPLETENESS, PERFORMANCE
  22. * OR MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  23. * IN NO EVENT SHALL ALLWINNER BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  24. * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  25. * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  26. * LOSS OF USE, DATA, OR PROFITS, OR BUSINESS INTERRUPTION)
  27. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
  28. * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  29. * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
  30. * OF THE POSSIBILITY OF SUCH DAMAGE.
  31. */
  32. #include "sunxi_htimer.h"
  33. #include "aw_common.h"
  34. #include <stdlib.h>
  35. #include <io.h>
  36. #include <interrupt.h>
  37. static struct sunxi_htimer *g_htimer;
  38. static const int sunxi_htimer_irq_num[] =
  39. {
  40. SUNXI_IRQ_HSTIMER0,
  41. SUNXI_IRQ_HSTIMER1,
  42. };
  43. static void sunxi_htimer_irq_handle(int dummy, void *data)
  44. {
  45. struct sunxi_htimer *timer = (struct sunxi_htimer *)data;
  46. /* clear pending */
  47. writel((0x1 << timer->timer_id), HTIMER_IRQ_ST_REG);
  48. /*callback*/
  49. if (timer->callback != NULL)
  50. {
  51. timer->callback(timer->param);
  52. }
  53. }
  54. static void sunxi_htimer_sync(uint32_t timer)
  55. {
  56. uint32_t old = readl(HTIMER_CNTVAL_LO_REG(timer));
  57. while ((old - readl(HTIMER_CNTVAL_LO_REG(timer))) < HTIMER_SYNC_TICKS)
  58. {
  59. int i = 10;
  60. while (i--);
  61. break;
  62. }
  63. }
  64. void sunxi_htimer_stop(uint32_t timer)
  65. {
  66. uint32_t val = readl(HTIMER_CTL_REG(timer));
  67. writel(val & ~HTIMER_CTL_ENABLE, HTIMER_CTL_REG(timer));
  68. sunxi_htimer_sync(timer);
  69. }
  70. void sunxi_htimer_start(uint32_t timer, bool periodic)
  71. {
  72. uint32_t val = readl(HTIMER_CTL_REG(timer));
  73. if (periodic)
  74. {
  75. val &= ~HTIMER_CTL_ONESHOT;
  76. }
  77. else
  78. {
  79. val |= HTIMER_CTL_ONESHOT;
  80. }
  81. val |= HTIMER_CTL_CLK_PRES(1); //100M
  82. writel(val | HTIMER_CTL_ENABLE | HTIMER_CTL_RELOAD, HTIMER_CTL_REG(timer));
  83. }
  84. static void sunxi_htimer_setup(uint32_t tick, uint32_t timer)
  85. {
  86. writel(tick, HTIMER_INTVAL_LO_REG(timer));
  87. }
  88. int sunxi_htimer_set_oneshot(uint32_t delay_us, uint32_t timer, timer_callback callback, void *callback_param)
  89. {
  90. uint32_t tick = delay_us * 100;
  91. if (tick < g_htimer[timer].min_delta_ticks || tick > g_htimer[timer].max_delta_ticks)
  92. {
  93. HTIMER_INFO("not support!\n");
  94. return -1;
  95. }
  96. if (callback != NULL)
  97. {
  98. g_htimer[timer].callback = callback;
  99. g_htimer[timer].param = callback_param;
  100. }
  101. sunxi_htimer_stop(timer);
  102. sunxi_htimer_setup(tick, timer);
  103. sunxi_htimer_start(timer, false);
  104. }
  105. int sunxi_htimer_set_periodic(uint32_t delay_us, uint32_t timer, timer_callback callback, void *callback_param)
  106. {
  107. uint32_t tick = delay_us * 100;
  108. if (tick < g_htimer[timer].min_delta_ticks || tick > g_htimer[timer].max_delta_ticks)
  109. {
  110. HTIMER_INFO("not support!\n");
  111. return -1;
  112. }
  113. if (callback != NULL)
  114. {
  115. g_htimer[timer].callback = callback;
  116. g_htimer[timer].param = callback_param;
  117. }
  118. sunxi_htimer_stop(timer);
  119. sunxi_htimer_setup(tick, timer);
  120. sunxi_htimer_start(timer, true);
  121. }
  122. void sunxi_htimer_init(void)
  123. {
  124. int i;
  125. struct sunxi_htimer *timer = NULL;
  126. uint32_t val;
  127. uint32_t size = ARRAY_SIZE(sunxi_htimer_irq_num);
  128. for (i = 0; i < size; i++)
  129. {
  130. /* disable all hrtimer */
  131. val = readl(HTIMER_CTL_REG(i));
  132. writel(val & ~HTIMER_CTL_ENABLE, HTIMER_CTL_REG(i));
  133. }
  134. /* clear pending */
  135. writel(0x3, HTIMER_IRQ_ST_REG);
  136. timer = (struct sunxi_htimer *)malloc(size * sizeof(struct sunxi_htimer));
  137. if (timer == NULL)
  138. {
  139. HTIMER_INFO("alloc memory error!\n");
  140. return;
  141. }
  142. for (i = 0; i < size; i++)
  143. {
  144. timer[i].timer_id = i;
  145. timer[i].clk_rate = 200000000; //ahb1,should get form clk driver
  146. timer[i].irq = sunxi_htimer_irq_num[i];
  147. timer[i].min_delta_ticks = HTIMER_SYNC_TICKS;
  148. timer[i].max_delta_ticks = 0xffffffff;
  149. timer[i].callback = NULL;
  150. timer[i].param = NULL;
  151. irq_request(timer[i].irq, sunxi_htimer_irq_handle, (void *)&timer[i]);
  152. }
  153. /*enable timer irq*/
  154. for (i = 0; i < size; i++)
  155. {
  156. val = readl(HTIMER_IRQ_EN_REG);
  157. val |= HTIMER_IRQ_EN(i);
  158. writel(val, HTIMER_IRQ_EN_REG);
  159. }
  160. /* enable irq */
  161. for (i = 0; i < size; i++)
  162. {
  163. irq_enable(timer[i].irq);
  164. }
  165. g_htimer = timer;
  166. }