mt_gpt.c 10 KB

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