1 /* SPDX-License-Identifier: GPL-2.0-only */
6 #include <soc/rtc_common.h>
7 #include <soc/mt6358.h>
8 #include <soc/pmic_wrap.h>
11 /* initialize rtc setting of using dcxo clock */
12 static bool rtc_enable_dcxo(void)
14 u16 bbpu
, con
, osc32con
, sec
;
16 rtc_read(RTC_BBPU
, &bbpu
);
17 rtc_write(RTC_BBPU
, bbpu
| RTC_BBPU_KEY
| RTC_BBPU_RELOAD
);
21 if (!rtc_writeif_unlock()) {
22 rtc_info("rtc_writeif_unlock() failed\n");
26 rtc_read(RTC_OSC32CON
, &osc32con
);
27 osc32con
&= ~(RTC_EMBCK_SRC_SEL
| RTC_EMBCK_SEL_MODE_MASK
29 osc32con
|= RTC_XOSC32_ENB
| RTC_REG_XOSC32_ENB
30 | RTC_EMB_K_EOSC32_MODE
| RTC_EMBCK_SEL_OPTION
;
31 if (!rtc_xosc_write(osc32con
)) {
32 rtc_info("rtc_xosc_write() failed\n");
36 rtc_read(RTC_CON
, &con
);
37 rtc_read(RTC_OSC32CON
, &osc32con
);
38 rtc_read(RTC_AL_SEC
, &sec
);
39 rtc_info("con=0x%x, osc32con=0x%x, sec=0x%x\n", con
, osc32con
, sec
);
44 /* initialize rtc related gpio */
45 bool rtc_gpio_init(void)
49 /* RTC_32K1V8 clock change from 128k div 4 source
52 pwrap_write_field(PMIC_RG_TOP_CKSEL_CON0_SET
, 0x1, 0x1, 3);
54 /* Export 32K clock RTC_32K1V8_1 */
55 pwrap_write_field(PMIC_RG_TOP_CKPDN_CON1_CLR
, 0x1, 0x1, 1);
57 /* Export 32K clock RTC_32K2V8 */
58 rtc_read(RTC_CON
, &con
);
59 con
&= (RTC_CON_LPSTA_RAW
| RTC_CON_LPRST
| RTC_CON_EOSC32_LPEN
60 | RTC_CON_XOSC32_LPEN
);
61 con
|= (RTC_CON_GPEN
| RTC_CON_GOE
);
62 con
&= ~(RTC_CON_F32KOB
);
63 rtc_write(RTC_CON
, con
);
65 return rtc_write_trigger();
68 u16
rtc_get_frequency_meter(u16 val
, u16 measure_src
, u16 window_size
)
71 u16 fqmtr_busy
, fqmtr_data
, fqmtr_rst
, fqmtr_tcksel
;
75 rtc_read(RTC_BBPU
, &bbpu
);
76 rtc_write(RTC_BBPU
, bbpu
| RTC_BBPU_KEY
| RTC_BBPU_RELOAD
);
78 rtc_read(RTC_OSC32CON
, &osc32con
);
79 rtc_xosc_write((osc32con
& ~RTC_XOSCCALI_MASK
) |
80 (val
& RTC_XOSCCALI_MASK
));
83 /* enable FQMTR clock */
84 pwrap_write_field(PMIC_RG_TOP_CKPDN_CON0_CLR
, 1, 1,
85 PMIC_RG_FQMTR_32K_CK_PDN_SHIFT
);
86 pwrap_write_field(PMIC_RG_TOP_CKPDN_CON0_CLR
, 1, 1,
87 PMIC_RG_FQMTR_CK_PDN_SHIFT
);
90 pwrap_write_field(PMIC_RG_FQMTR_RST
, 1, 1, PMIC_FQMTR_RST_SHIFT
);
92 rtc_read(PMIC_RG_FQMTR_DATA
, &fqmtr_data
);
93 rtc_read(PMIC_RG_FQMTR_CON0
, &fqmtr_busy
);
94 } while (fqmtr_data
&& (fqmtr_busy
& PMIC_FQMTR_CON0_BUSY
));
95 rtc_read(PMIC_RG_FQMTR_RST
, &fqmtr_rst
);
97 pwrap_write_field(PMIC_RG_FQMTR_RST
, 0, 1, PMIC_FQMTR_RST_SHIFT
);
99 /* set frequency meter window value (0=1X32K(fixed clock)) */
100 rtc_write(PMIC_RG_FQMTR_WINSET
, window_size
);
101 /* enable 26M and set test clock source */
102 rtc_write(PMIC_RG_FQMTR_CON0
, PMIC_FQMTR_CON0_DCXO26M_EN
| measure_src
);
103 /* enable 26M -> delay 100us -> enable FQMTR */
105 rtc_read(PMIC_RG_FQMTR_CON0
, &fqmtr_tcksel
);
107 rtc_write(PMIC_RG_FQMTR_CON0
, fqmtr_tcksel
| PMIC_FQMTR_CON0_FQMTR_EN
);
110 stopwatch_init_usecs_expire(&sw
, FQMTR_TIMEOUT_US
);
111 /* FQMTR read until ready */
113 rtc_read(PMIC_RG_FQMTR_CON0
, &fqmtr_busy
);
114 if (stopwatch_expired(&sw
)) {
115 rtc_info("get frequency time out !!\n");
118 } while (fqmtr_busy
& PMIC_FQMTR_CON0_BUSY
);
120 /* read data should be closed to 26M/32k = 794 */
121 rtc_read(PMIC_RG_FQMTR_DATA
, &fqmtr_data
);
123 rtc_read(PMIC_RG_FQMTR_CON0
, &fqmtr_tcksel
);
125 rtc_write(PMIC_RG_FQMTR_CON0
, fqmtr_tcksel
& ~PMIC_FQMTR_CON0_FQMTR_EN
);
126 /* disable FQMTR -> delay 100us -> disable 26M */
129 rtc_read(PMIC_RG_FQMTR_CON0
, &fqmtr_tcksel
);
130 rtc_write(PMIC_RG_FQMTR_CON0
,
131 fqmtr_tcksel
& ~PMIC_FQMTR_CON0_DCXO26M_EN
);
132 rtc_info("input=0x%x, output=%d\n", val
, fqmtr_data
);
134 /* disable FQMTR clock */
135 pwrap_write_field(PMIC_RG_TOP_CKPDN_CON0_SET
, 1, 1,
136 PMIC_RG_FQMTR_32K_CK_PDN_SHIFT
);
137 pwrap_write_field(PMIC_RG_TOP_CKPDN_CON0_SET
, 1, 1,
138 PMIC_RG_FQMTR_CK_PDN_SHIFT
);
143 /* low power detect setting */
144 static bool rtc_lpd_init(void)
148 /* set RTC_LPD_OPT */
149 rtc_read(RTC_AL_SEC
, &sec
);
150 sec
|= RTC_LPD_OPT_F32K_CK_ALIVE
;
151 rtc_write(RTC_AL_SEC
, sec
);
152 if (!rtc_write_trigger())
155 /* init XOSC32 to detect 32k clock stop */
156 rtc_read(RTC_CON
, &con
);
157 con
|= RTC_CON_XOSC32_LPEN
;
161 /* init EOSC32 to detect rtc low power */
162 rtc_read(RTC_CON
, &con
);
163 con
|= RTC_CON_EOSC32_LPEN
;
167 rtc_read(RTC_CON
, &con
);
168 con
&= ~RTC_CON_XOSC32_LPEN
;
169 rtc_write(RTC_CON
, con
);
171 /* set RTC_LPD_OPT */
172 rtc_read(RTC_AL_SEC
, &sec
);
173 sec
&= ~RTC_LPD_OPT_MASK
;
174 sec
|= RTC_LPD_OPT_EOSC_LPD
;
175 rtc_write(RTC_AL_SEC
, sec
);
176 if (!rtc_write_trigger())
182 static bool rtc_hw_init(void)
186 rtc_read(RTC_BBPU
, &bbpu
);
187 rtc_write(RTC_BBPU
, bbpu
| RTC_BBPU_KEY
| RTC_BBPU_INIT
);
192 rtc_read(RTC_BBPU
, &bbpu
);
193 rtc_write(RTC_BBPU
, bbpu
| RTC_BBPU_KEY
| RTC_BBPU_RELOAD
);
196 rtc_read(RTC_BBPU
, &bbpu
);
197 if (bbpu
& RTC_BBPU_INIT
) {
198 rtc_info("timeout\n");
206 int rtc_init(int recover
)
210 rtc_info("recovery: %d\n", recover
);
212 /* write powerkeys to enable rtc functions */
213 if (!rtc_powerkey_init()) {
214 ret
= -RTC_STATUS_POWERKEY_INIT_FAIL
;
218 /* write interface unlock need to be set after powerkey match */
219 if (!rtc_writeif_unlock()) {
220 ret
= -RTC_STATUS_WRITEIF_UNLOCK_FAIL
;
226 /* In recovery mode, we need 20ms delay for register setting. */
230 if (!rtc_gpio_init()) {
231 ret
= -RTC_STATUS_GPIO_INIT_FAIL
;
235 if (!rtc_hw_init()) {
236 ret
= -RTC_STATUS_HW_INIT_FAIL
;
240 if (!rtc_reg_init()) {
241 ret
= -RTC_STATUS_REG_INIT_FAIL
;
245 if (!rtc_lpd_init()) {
246 ret
= -RTC_STATUS_LPD_INIT_FAIL
;
251 * After lpd init, powerkeys need to be written again to enable
252 * low power detect function.
254 if (!rtc_powerkey_init()) {
255 ret
= -RTC_STATUS_POWERKEY_INIT_FAIL
;
259 return RTC_STATUS_OK
;
261 rtc_info("init fail: ret=%d\n", ret
);
265 /* enable rtc bbpu */
266 void rtc_bbpu_power_on(void)
271 /* pull powerhold high, control by pmic */
272 pmic_set_power_hold(true);
274 /* pull PWRBB high */
275 bbpu
= RTC_BBPU_KEY
| RTC_BBPU_AUTO
| RTC_BBPU_RELOAD
| RTC_BBPU_PWREN
;
276 rtc_write(RTC_BBPU
, bbpu
);
277 ret
= rtc_write_trigger();
278 rtc_info("rtc_write_trigger=%d\n", ret
);
280 rtc_read(RTC_BBPU
, &bbpu
);
281 rtc_info("done BBPU=%#x\n", bbpu
);
288 if (!rtc_writeif_unlock())
289 rtc_info("rtc_writeif_unlock() failed\n");
291 bbpu
= RTC_BBPU_KEY
| RTC_BBPU_RELOAD
| RTC_BBPU_PWREN
;
292 rtc_write(RTC_BBPU
, bbpu
);
294 pmic_set_power_hold(false);
298 static void dcxo_init(void)
301 rtc_write(PMIC_RG_DCXO_CW15
, 0xA2AA);
302 rtc_write(PMIC_RG_DCXO_CW13
, 0x98E9);
303 rtc_write(PMIC_RG_DCXO_CW16
, 0x9855);
305 /* 26M enable control */
306 /* Enable clock buffer XO_SOC, XO_CEL */
307 rtc_write(PMIC_RG_DCXO_CW00
, 0x4805);
308 rtc_write(PMIC_RG_DCXO_CW11
, 0x8000);
310 /* Load thermal coefficient */
311 rtc_write(PMIC_RG_TOP_TMA_KEY
, 0x9CA7);
312 rtc_write(PMIC_RG_DCXO_CW21
, 0x12A7);
313 rtc_write(PMIC_RG_DCXO_ELR0
, 0xD004);
314 rtc_write(PMIC_RG_TOP_TMA_KEY
, 0x0000);
316 /* Adjust OSC FPM setting */
317 rtc_write(PMIC_RG_DCXO_CW07
, 0x8FFE);
319 /* Re-Calibrate OSC current */
320 rtc_write(PMIC_RG_DCXO_CW09
, 0x008F);
322 rtc_write(PMIC_RG_DCXO_CW09
, 0x408F);
326 void mt6358_dcxo_disable_unused(void)
328 /* Disable clock buffer XO_CEL */
329 rtc_write(PMIC_RG_DCXO_CW00_CLR
, 0x0800);
330 /* Mask bblpm request and switch off bblpm mode */
331 rtc_write(PMIC_RG_DCXO_CW23
, 0x0052);
334 /* the rtc boot flow entry */
337 /* dcxo clock init settings */
340 /* dcxo 32k init settings */
341 pwrap_write_field(PMIC_RG_DCXO_CW02
, 0xF, 0xF, 0);
342 pwrap_write_field(PMIC_RG_SCK_TOP_CON0
, 0x1, 0x1, 0);
344 /* use dcxo 32K clock */
345 if (!rtc_enable_dcxo())
346 rtc_info("rtc_enable_dcxo() failed\n");