mt_gpt_v3.c 10 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400
  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_gpt.h>
  38. #include <platform/mt_irq.h>
  39. #include <platform/boot_mode.h>
  40. typedef volatile unsigned int* P_U32;
  41. #define GPT4_CON ((P_U32)(APXGPT_BASE+0x0040))
  42. #define GPT4_CLK ((P_U32)(APXGPT_BASE+0x0044))
  43. #define GPT4_DAT ((P_U32)(APXGPT_BASE+0x0048))
  44. #define GPT4_EN 0x0001
  45. #define GPT4_FREERUN 0x0030
  46. #define GPT4_SYS_CLK 0x0000
  47. #define GPT4_MAX_TICK_CNT ((U32)0xFFFFFFFF)
  48. // 13MHz setting
  49. #define GPT4_MAX_US_TIMEOUT ((U32)330382100) // 0xFFFFFFFF /13d
  50. #define GPT4_MAX_MS_TIMEOUT ((U32)330382) // 0xFFFFFFFF /13000d
  51. #define GPT4_1US_TICK ((U32)13) // 1000 / 76.92ns = 13.000
  52. #define GPT4_1MS_TICK ((U32)13000) // 1000000 / 76.92ns = 13000.520
  53. // 13MHz: 1us = 13.000 ticks
  54. #define TIME_TO_TICK_US(us) ((us)*GPT4_1US_TICK + ((us)*0 + (1000-1))/1000)
  55. // 13MHz: 1ms = 13000.520 ticks
  56. #define TIME_TO_TICK_MS(ms) ((ms)*GPT4_1MS_TICK + ((ms)*520 + (1000-1))/1000)
  57. #define MS_TO_US 1000
  58. #define CFG_HZ 100
  59. #define MAX_REG_MS GPT4_MAX_MS_TIMEOUT
  60. #define GPT_SET_BITS(BS,REG) ((*(volatile U32*)(REG)) |= (U32)(BS))
  61. #define GPT_CLR_BITS(BS,REG) ((*(volatile U32*)(REG)) &= ~((U32)(BS)))
  62. static volatile U32 timestamp;
  63. static volatile U32 lastinc;
  64. extern BOOT_ARGUMENT *g_boot_arg;
  65. //===========================================================================
  66. // GPT4 fixed 13MHz counter
  67. //===========================================================================
  68. /*
  69. static void gpt_power_on (bool bPowerOn)
  70. {
  71. #define AP_PERI_GLOBALCON_PDN0 (PERI_CON_BASE+0x10)
  72. if(!bPowerOn){
  73. GPT_SET_BITS(1<<13, AP_PERI_GLOBALCON_PDN0);
  74. }else{
  75. GPT_CLR_BITS(1<<13, AP_PERI_GLOBALCON_PDN0);
  76. }
  77. }
  78. */
  79. static void gpt4_start (void)
  80. {
  81. *GPT4_CLK = (GPT4_SYS_CLK);
  82. *GPT4_CON = (GPT4_EN|GPT4_FREERUN);
  83. }
  84. static void gpt4_stop (void)
  85. {
  86. *GPT4_CON = 0x0; // disable
  87. *GPT4_CON = 0x2; // clear counter
  88. }
  89. static void gpt4_init (bool bStart)
  90. {
  91. // power on GPT
  92. //gpt_power_on (TRUE);
  93. // clear GPT4 first
  94. gpt4_stop ();
  95. // enable GPT4 without lock
  96. if (bStart) {
  97. gpt4_start ();
  98. }
  99. }
  100. U32 gpt4_get_current_tick (void)
  101. {
  102. U32 cnt1, cnt2, cnt3,value1;
  103. cnt1 = (*GPT4_DAT);
  104. cnt2 = (*GPT4_DAT);
  105. cnt3 = (*GPT4_DAT);
  106. if (cnt2 < cnt1) {
  107. if (cnt1 < cnt3)
  108. value1 = cnt1;
  109. else {
  110. value1 = ((cnt2 > cnt3) ? cnt2 :cnt3);
  111. }
  112. } else {
  113. if (cnt2 < cnt3)
  114. value1 = cnt2;
  115. else {
  116. value1= ((cnt1 > cnt3) ? cnt1 :cnt3);
  117. }
  118. }
  119. return value1;
  120. //return (*GPT4_DAT);
  121. }
  122. bool gpt4_timeout_tick (U32 start_tick, U32 timeout_tick)
  123. {
  124. register U32 cur_tick;
  125. register U32 elapse_tick;
  126. // get current tick
  127. cur_tick = gpt4_get_current_tick ();
  128. // check elapse time
  129. if (start_tick <= cur_tick) {
  130. elapse_tick = cur_tick - start_tick;
  131. } else {
  132. elapse_tick = (GPT4_MAX_TICK_CNT - start_tick) + cur_tick;
  133. }
  134. // check if timeout
  135. if (timeout_tick <= elapse_tick) {
  136. // timeout
  137. return TRUE;
  138. }
  139. return FALSE;
  140. }
  141. //===========================================================================
  142. // us interface
  143. //===========================================================================
  144. U32 gpt4_tick2time_us (U32 tick)
  145. {
  146. return ((tick + (GPT4_1US_TICK - 1)) / GPT4_1US_TICK);
  147. }
  148. U32 gpt4_time2tick_us (U32 time_us)
  149. {
  150. if (GPT4_MAX_US_TIMEOUT <= time_us) {
  151. return GPT4_MAX_US_TIMEOUT;
  152. } else {
  153. return TIME_TO_TICK_US (time_us);
  154. }
  155. }
  156. //===========================================================================
  157. // ms interface
  158. //===========================================================================
  159. U32 gpt4_tick2time_ms (U32 tick)
  160. {
  161. return ((tick + (GPT4_1MS_TICK - 1)) / GPT4_1MS_TICK);
  162. }
  163. U32 global_tick2time_ms (void)
  164. {
  165. volatile U32 now;
  166. if (g_boot_arg->boot_mode == DOWNLOAD_BOOT) {
  167. register U32 cur_tick;
  168. // get current tick from APXGPT because DOWNLOAD_BOOT do not ATF init
  169. cur_tick = gpt4_get_current_tick ();
  170. now = gpt4_tick2time_ms (cur_tick);
  171. } else {
  172. register U64 cur_tick;
  173. // get current tick from ARM generic timer which is enabled on ATF before LK for boottime measure
  174. cur_tick = arch_counter_get_cntpct();
  175. now = ((cur_tick & CNTPCT_BIT_MASK_L) + (CNTPCT_1MS_TICK - 1)) / CNTPCT_1MS_TICK;
  176. }
  177. return now;
  178. }
  179. static U32 gpt4_time2tick_ms (U32 time_ms)
  180. {
  181. if (GPT4_MAX_MS_TIMEOUT <= time_ms) {
  182. return GPT4_MAX_MS_TIMEOUT;
  183. } else {
  184. return TIME_TO_TICK_MS (time_ms);
  185. }
  186. }
  187. //===========================================================================
  188. // bust wait
  189. //===========================================================================
  190. void gpt_busy_wait_us (U32 timeout_us)
  191. {
  192. U32 start_tick, timeout_tick;
  193. // get timeout tick
  194. timeout_tick = gpt4_time2tick_us (timeout_us);
  195. start_tick = gpt4_get_current_tick ();
  196. // wait for timeout
  197. while (!gpt4_timeout_tick (start_tick, timeout_tick));
  198. }
  199. void gpt_busy_wait_ms (U32 timeout_ms)
  200. {
  201. U32 start_tick, timeout_tick;
  202. // get timeout tick
  203. timeout_tick = gpt4_time2tick_ms (timeout_ms);
  204. start_tick = gpt4_get_current_tick ();
  205. // wait for timeout
  206. while (!gpt4_timeout_tick (start_tick, timeout_tick));
  207. }
  208. //======================================================================
  209. void reset_timer_masked (void)
  210. {
  211. lastinc = global_tick2time_ms();
  212. timestamp = 0;
  213. }
  214. ulong get_timer_masked (void)
  215. {
  216. volatile U32 now;
  217. register U32 cur_tick;
  218. /* get current tick - fall back to MT6735 */
  219. cur_tick = gpt4_get_current_tick ();
  220. now = gpt4_tick2time_ms (cur_tick);
  221. if (now >= lastinc) {
  222. timestamp = timestamp + now - lastinc; /* normal */
  223. } else {
  224. timestamp = timestamp + MAX_REG_MS - lastinc + now; /* overflow */
  225. }
  226. lastinc = now;
  227. return timestamp;
  228. }
  229. void reset_timer (void)
  230. {
  231. reset_timer_masked ();
  232. }
  233. #define MAX_TIMESTAMP_MS 0xffffffff
  234. ulong get_timer (ulong base)
  235. {
  236. ulong current_timestamp = 0;
  237. ulong temp = 0;
  238. current_timestamp = get_timer_masked ();
  239. if (current_timestamp >= base) {
  240. /* timestamp normal */
  241. return (current_timestamp - base);
  242. }
  243. /* timestamp overflow */
  244. //dbg_print("return = 0x%x\n",MAX_TIMESTAMP_MS - ( base - current_timestamp ));
  245. temp = base - current_timestamp;
  246. return (MAX_TIMESTAMP_MS - temp);
  247. }
  248. void set_timer (ulong ticks)
  249. {
  250. timestamp = ticks;
  251. }
  252. /* delay msec mseconds */
  253. void mdelay (unsigned long msec)
  254. {
  255. gpt_busy_wait_ms(msec);
  256. }
  257. /* delay usec useconds */
  258. void udelay (unsigned long usec)
  259. {
  260. gpt_busy_wait_us(usec);
  261. }
  262. /*
  263. * This function is derived from PowerPC code (read timebase as long long).
  264. * On ARM it just returns the timer value.
  265. */
  266. unsigned long long get_ticks(void)
  267. {
  268. return (unsigned long long) get_timer (0);
  269. }
  270. /*
  271. * This function is derived from PowerPC code (timebase clock frequency).
  272. * On ARM it returns the number of timer ticks per second.
  273. */
  274. ulong get_tbclk (void)
  275. {
  276. ulong tbclk;
  277. tbclk = CFG_HZ;
  278. return tbclk;
  279. }
  280. void mtk_timer_init (void)
  281. {
  282. gpt4_init (TRUE);
  283. // init timer system
  284. reset_timer ();
  285. }
  286. /*********************************************************************************************
  287. * This following is used to wake up system for battery charge in u-boot.
  288. * Note, the maximux "ms" value of function "gpt_one_shot_irq" is 131071
  289. *********************************************************************************************/
  290. #define GPT6_CON (APXGPT_BASE+0x0060)
  291. #define GPT6_CLK (APXGPT_BASE+0x0064)
  292. #define GPT6_CMP_L (APXGPT_BASE+0x006C)
  293. #define GPT6_CMP_H (APXGPT_BASE+0x007C)
  294. #define GPT_IRQ_EN (APXGPT_BASE+0x0000)
  295. #define GPT_IRQ_ACK (APXGPT_BASE+0x0008)
  296. #define GPT6_ONE_SHOT_EN 0x0001
  297. #define GPT6_RTC_CLK 0x0010
  298. #define GPT6_IRQ_BIT (1<<5)
  299. #define GPT6_STOP_CLEAR (1<<1)
  300. void gpt_one_shot_irq(unsigned int ms)
  301. {
  302. // Using GPT6 as trigger source
  303. // 1. Stop and clear GPT
  304. DRV_WriteReg32(GPT6_CON, GPT6_STOP_CLEAR);
  305. // 2. Clear pending irq
  306. DRV_WriteReg32(GPT_IRQ_ACK, GPT6_IRQ_BIT);
  307. // 3. Configure GPT divider to 1 and using 32K clock source
  308. DRV_WriteReg32(GPT6_CLK, GPT6_RTC_CLK);
  309. // 4. Calculate and Set compare value
  310. DRV_WriteReg32(GPT6_CMP_L, 32768*ms/1000);
  311. // 5. Enabel IRQ En
  312. DRV_SetReg32(GPT_IRQ_EN, GPT6_IRQ_BIT);
  313. // 6. Start GPT one-shot
  314. DRV_WriteReg32(GPT6_CON, GPT6_ONE_SHOT_EN);
  315. }
  316. int gpt_irq_init(void)
  317. {
  318. //1. Disable all gpt irq bits
  319. DRV_WriteReg32(GPT_IRQ_EN, 0);
  320. //2. Ack all gpt irq if needed
  321. DRV_WriteReg32(GPT_IRQ_ACK, 0x3F);
  322. //3. Register gpt irq for GIC
  323. mt_irq_set_sens(MT_GPT_IRQ_ID, MT65xx_LEVEL_SENSITIVE);
  324. mt_irq_set_polarity(MT_GPT_IRQ_ID, MT65xx_POLARITY_LOW);
  325. return 0;
  326. }
  327. void gpt_irq_ack()
  328. {
  329. DRV_WriteReg32(GPT_IRQ_ACK, GPT6_IRQ_BIT);
  330. }