mt_gpt_v4.c 10 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383
  1. /* Copyright Statement:
  2. *
  3. * This software/firmware and related documentation ("MediaTek Software") are
  4. * protected under relevant copyright laws. The information contained herein
  5. * is confidential and proprietary to MediaTek Inc. and/or its licensors.
  6. * Without the prior written permission of MediaTek inc. and/or its licensors,
  7. * any reproduction, modification, use or disclosure of MediaTek Software,
  8. * and information contained herein, in whole or in part, shall be strictly prohibited.
  9. */
  10. /* MediaTek Inc. (C) 2018. All rights reserved.
  11. *
  12. * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
  13. * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
  14. * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON
  15. * AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
  16. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
  17. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
  18. * NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
  19. * SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
  20. * SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH
  21. * THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES
  22. * THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES
  23. * CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK
  24. * SOFTWARE RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
  25. * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND
  26. * CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
  27. * AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
  28. * OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO
  29. * MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
  30. */
  31. #include <sys/types.h>
  32. #include <debug.h>
  33. #include <err.h>
  34. #include <reg.h>
  35. #include <platform/mt_typedefs.h>
  36. #include <platform/mt_reg_base.h>
  37. #include <platform/mt_irq.h>
  38. #include <platform/boot_mode.h>
  39. #include <mt_gic.h>
  40. #include <mt_gpt_common.h>
  41. typedef volatile unsigned int* P_U32;
  42. #define GPT4_CON ((P_U32)(APXGPT_BASE+0x0040))
  43. #define GPT4_CLK ((P_U32)(APXGPT_BASE+0x0044))
  44. #define GPT4_DAT ((P_U32)(APXGPT_BASE+0x0048))
  45. #define GPT4_EN 0x0001
  46. #define GPT4_FREERUN 0x0030
  47. #define GPT4_SYS_CLK 0x0000
  48. #define GPT4_MAX_TICK_CNT ((U32)0xFFFFFFFF)
  49. // 13MHz setting
  50. #define GPT4_MAX_US_TIMEOUT ((U32)330382100) // 0xFFFFFFFF /13d
  51. #define GPT4_MAX_MS_TIMEOUT ((U32)330382) // 0xFFFFFFFF /13000d
  52. #define GPT4_1US_TICK ((U32)13) // 1000 / 76.92ns = 13.000
  53. #define GPT4_1MS_TICK ((U32)13000) // 1000000 / 76.92ns = 13000.520
  54. // 13MHz: 1us = 13.000 ticks
  55. #define TIME_TO_TICK_US(us) ((us)*GPT4_1US_TICK + ((us)*0 + (1000-1))/1000)
  56. // 13MHz: 1ms = 13000.520 ticks
  57. #define TIME_TO_TICK_MS(ms) ((ms)*GPT4_1MS_TICK + ((ms)*520 + (1000-1))/1000)
  58. #define MS_TO_US 1000
  59. #define CFG_HZ 100
  60. #define MAX_REG_MS GPT4_MAX_MS_TIMEOUT
  61. #define GPT_SET_BITS(BS,REG) ((*(volatile U32*)(REG)) |= (U32)(BS))
  62. #define GPT_CLR_BITS(BS,REG) ((*(volatile U32*)(REG)) &= ~((U32)(BS)))
  63. static volatile U32 timestamp;
  64. static volatile U32 lastinc;
  65. extern BOOT_ARGUMENT *g_boot_arg;
  66. //===========================================================================
  67. // GPT4 fixed 13MHz counter
  68. //===========================================================================
  69. static void gpt4_start (void)
  70. {
  71. *GPT4_CLK = (GPT4_SYS_CLK);
  72. *GPT4_CON = (GPT4_EN|GPT4_FREERUN);
  73. }
  74. static void gpt4_stop (void)
  75. {
  76. *GPT4_CON = 0x0; // disable
  77. *GPT4_CON = 0x2; // clear counter
  78. }
  79. static void gpt4_init (bool bStart)
  80. {
  81. // power on GPT
  82. //gpt_power_on (TRUE);
  83. // clear GPT4 first
  84. gpt4_stop ();
  85. // enable GPT4 without lock
  86. if (bStart) {
  87. gpt4_start ();
  88. }
  89. }
  90. U32 gpt4_get_current_tick (void)
  91. {
  92. U32 cnt1, cnt2, cnt3,value1;
  93. cnt1 = (*GPT4_DAT);
  94. cnt2 = (*GPT4_DAT);
  95. cnt3 = (*GPT4_DAT);
  96. if (cnt2 < cnt1) {
  97. if (cnt1 < cnt3)
  98. value1 = cnt1;
  99. else {
  100. value1 = ((cnt2 > cnt3) ? cnt2 :cnt3);
  101. }
  102. } else {
  103. if (cnt2 < cnt3)
  104. value1 = cnt2;
  105. else {
  106. value1= ((cnt1 > cnt3) ? cnt1 :cnt3);
  107. }
  108. }
  109. return value1;
  110. //return (*GPT4_DAT);
  111. }
  112. bool gpt4_timeout_tick (U32 start_tick, U32 timeout_tick)
  113. {
  114. register U32 cur_tick;
  115. register U32 elapse_tick;
  116. // get current tick
  117. cur_tick = gpt4_get_current_tick ();
  118. // check elapse time
  119. if (start_tick <= cur_tick) {
  120. elapse_tick = cur_tick - start_tick;
  121. } else {
  122. elapse_tick = (GPT4_MAX_TICK_CNT - start_tick) + cur_tick;
  123. }
  124. // check if timeout
  125. if (timeout_tick <= elapse_tick) {
  126. // timeout
  127. return TRUE;
  128. }
  129. return FALSE;
  130. }
  131. //===========================================================================
  132. // us interface
  133. //===========================================================================
  134. U32 gpt4_tick2time_us (U32 tick)
  135. {
  136. return ((tick + (GPT4_1US_TICK - 1)) / GPT4_1US_TICK);
  137. }
  138. U32 gpt4_time2tick_us (U32 time_us)
  139. {
  140. if (GPT4_MAX_US_TIMEOUT <= time_us) {
  141. return GPT4_MAX_US_TIMEOUT;
  142. } else {
  143. return TIME_TO_TICK_US (time_us);
  144. }
  145. }
  146. //===========================================================================
  147. // ms interface
  148. //===========================================================================
  149. U32 gpt4_tick2time_ms (U32 tick)
  150. {
  151. return ((tick + (GPT4_1MS_TICK - 1)) / GPT4_1MS_TICK);
  152. }
  153. U32 global_tick2time_ms (void)
  154. {
  155. volatile U32 now;
  156. if (g_boot_arg->boot_mode == DOWNLOAD_BOOT) {
  157. register U32 cur_tick;
  158. // get current tick from APXGPT because DOWNLOAD_BOOT do not ATF init
  159. cur_tick = gpt4_get_current_tick ();
  160. now = gpt4_tick2time_ms (cur_tick);
  161. } else {
  162. register U64 cur_tick;
  163. // get current tick from ARM generic timer which is enabled on ATF before LK for boottime measure
  164. cur_tick = arch_counter_get_cntpct();
  165. now = ((cur_tick & CNTPCT_BIT_MASK_L) + (CNTPCT_1MS_TICK - 1)) / CNTPCT_1MS_TICK;
  166. }
  167. return now;
  168. }
  169. U32 gpt4_time2tick_ms (U32 time_ms)
  170. {
  171. if (GPT4_MAX_MS_TIMEOUT <= time_ms) {
  172. return GPT4_MAX_MS_TIMEOUT;
  173. } else {
  174. return TIME_TO_TICK_MS (time_ms);
  175. }
  176. }
  177. //===========================================================================
  178. // bust wait
  179. //===========================================================================
  180. void gpt_busy_wait_us (U32 timeout_us)
  181. {
  182. U32 start_tick, timeout_tick;
  183. // get timeout tick
  184. timeout_tick = gpt4_time2tick_us (timeout_us);
  185. start_tick = gpt4_get_current_tick ();
  186. // wait for timeout
  187. while (!gpt4_timeout_tick (start_tick, timeout_tick));
  188. }
  189. void gpt_busy_wait_ms (U32 timeout_ms)
  190. {
  191. U32 start_tick, timeout_tick;
  192. // get timeout tick
  193. timeout_tick = gpt4_time2tick_ms (timeout_ms);
  194. start_tick = gpt4_get_current_tick ();
  195. // wait for timeout
  196. while (!gpt4_timeout_tick (start_tick, timeout_tick));
  197. }
  198. //======================================================================
  199. void reset_timer_masked (void)
  200. {
  201. lastinc = global_tick2time_ms();
  202. timestamp = 0;
  203. }
  204. ulong get_timer_masked (void)
  205. {
  206. volatile U32 now;
  207. now = global_tick2time_ms();
  208. if (now >= lastinc) {
  209. timestamp = timestamp + now - lastinc; /* normal */
  210. } else {
  211. timestamp = timestamp + MAX_REG_MS - lastinc + now; /* overflow */
  212. }
  213. lastinc = now;
  214. return timestamp;
  215. }
  216. void reset_timer (void)
  217. {
  218. reset_timer_masked ();
  219. }
  220. #define MAX_TIMESTAMP_MS 0xffffffff
  221. ulong get_timer (ulong base)
  222. {
  223. ulong current_timestamp = 0;
  224. ulong temp = 0;
  225. current_timestamp = get_timer_masked ();
  226. if (current_timestamp >= base) {
  227. /* timestamp normal */
  228. return (current_timestamp - base);
  229. }
  230. /* timestamp overflow */
  231. //dbg_print("return = 0x%x\n",MAX_TIMESTAMP_MS - ( base - current_timestamp ));
  232. temp = base - current_timestamp;
  233. return (MAX_TIMESTAMP_MS - temp);
  234. }
  235. void set_timer (ulong ticks)
  236. {
  237. timestamp = ticks;
  238. }
  239. /* delay msec mseconds */
  240. void mdelay (unsigned long msec)
  241. {
  242. gpt_busy_wait_ms(msec);
  243. }
  244. /* delay usec useconds */
  245. void udelay (unsigned long usec)
  246. {
  247. gpt_busy_wait_us(usec);
  248. }
  249. /*
  250. * This function is derived from PowerPC code (read timebase as long long).
  251. * On ARM it just returns the timer value.
  252. */
  253. unsigned long long get_ticks(void)
  254. {
  255. return (unsigned long long) get_timer (0);
  256. }
  257. /*
  258. * This function is derived from PowerPC code (timebase clock frequency).
  259. * On ARM it returns the number of timer ticks per second.
  260. */
  261. ulong get_tbclk (void)
  262. {
  263. ulong tbclk;
  264. tbclk = CFG_HZ;
  265. return tbclk;
  266. }
  267. void mtk_timer_init (void)
  268. {
  269. gpt4_init (TRUE);
  270. // init timer system
  271. reset_timer ();
  272. }
  273. /*********************************************************************************************
  274. * This following is used to wake up system for battery charge in u-boot.
  275. * Note, the maximux "ms" value of function "gpt_one_shot_irq" is 131071
  276. *********************************************************************************************/
  277. #define GPT6_CON (APXGPT_BASE+0x0060)
  278. #define GPT6_CLK (APXGPT_BASE+0x0064)
  279. #define GPT6_CMP_L (APXGPT_BASE+0x006C)
  280. #define GPT6_CMP_H (APXGPT_BASE+0x007C)
  281. #define GPT_IRQ_EN (APXGPT_BASE+0x0000)
  282. #define GPT_IRQ_ACK (APXGPT_BASE+0x0008)
  283. #define GPT6_ONE_SHOT_EN 0x0001
  284. #define GPT6_RTC_CLK 0x0010
  285. #define GPT6_IRQ_BIT (1<<5)
  286. #define GPT6_STOP_CLEAR (1<<1)
  287. void gpt_one_shot_irq(unsigned int ms)
  288. {
  289. // Using GPT6 as trigger source
  290. // 1. Stop and clear GPT
  291. DRV_WriteReg32(GPT6_CON, GPT6_STOP_CLEAR);
  292. // 2. Clear pending irq
  293. DRV_WriteReg32(GPT_IRQ_ACK, GPT6_IRQ_BIT);
  294. // 3. Configure GPT divider to 1 and using 32K clock source
  295. DRV_WriteReg32(GPT6_CLK, GPT6_RTC_CLK);
  296. // 4. Calculate and Set compare value
  297. DRV_WriteReg32(GPT6_CMP_L, 32768*ms/1000);
  298. // 5. Enabel IRQ En
  299. DRV_SetReg32(GPT_IRQ_EN, GPT6_IRQ_BIT);
  300. // 6. Start GPT one-shot
  301. DRV_WriteReg32(GPT6_CON, GPT6_ONE_SHOT_EN);
  302. }
  303. int gpt_irq_init(void)
  304. {
  305. //1. Disable all gpt irq bits
  306. DRV_WriteReg32(GPT_IRQ_EN, 0);
  307. //2. Ack all gpt irq if needed
  308. DRV_WriteReg32(GPT_IRQ_ACK, 0x3F);
  309. //3. Register gpt irq for GIC
  310. mt_irq_set_sens(MT_GPT_IRQ_ID, MT65xx_LEVEL_SENSITIVE);
  311. mt_irq_set_polarity(MT_GPT_IRQ_ID, MT65xx_POLARITY_LOW);
  312. return 0;
  313. }
  314. void gpt_irq_ack()
  315. {
  316. DRV_WriteReg32(GPT_IRQ_ACK, GPT6_IRQ_BIT);
  317. }