2 * Copyright (c) 2014 MediaTek Inc.
3 * Author: Flora Fu, MediaTek
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
14 #include <linux/clk.h>
15 #include <linux/interrupt.h>
17 #include <linux/kernel.h>
18 #include <linux/module.h>
19 #include <linux/of_device.h>
20 #include <linux/platform_device.h>
21 #include <linux/regmap.h>
22 #include <linux/reset.h>
24 #define PWRAP_MT8135_BRIDGE_IORD_ARB_EN 0x4
25 #define PWRAP_MT8135_BRIDGE_WACS3_EN 0x10
26 #define PWRAP_MT8135_BRIDGE_INIT_DONE3 0x14
27 #define PWRAP_MT8135_BRIDGE_WACS4_EN 0x24
28 #define PWRAP_MT8135_BRIDGE_INIT_DONE4 0x28
29 #define PWRAP_MT8135_BRIDGE_INT_EN 0x38
30 #define PWRAP_MT8135_BRIDGE_TIMER_EN 0x48
31 #define PWRAP_MT8135_BRIDGE_WDT_UNIT 0x50
32 #define PWRAP_MT8135_BRIDGE_WDT_SRC_EN 0x54
34 /* macro for wrapper status */
35 #define PWRAP_GET_WACS_RDATA(x) (((x) >> 0) & 0x0000ffff)
36 #define PWRAP_GET_WACS_FSM(x) (((x) >> 16) & 0x00000007)
37 #define PWRAP_GET_WACS_REQ(x) (((x) >> 19) & 0x00000001)
38 #define PWRAP_STATE_SYNC_IDLE0 (1 << 20)
39 #define PWRAP_STATE_INIT_DONE0 (1 << 21)
41 /* macro for WACS FSM */
42 #define PWRAP_WACS_FSM_IDLE 0x00
43 #define PWRAP_WACS_FSM_REQ 0x02
44 #define PWRAP_WACS_FSM_WFDLE 0x04
45 #define PWRAP_WACS_FSM_WFVLDCLR 0x06
46 #define PWRAP_WACS_INIT_DONE 0x01
47 #define PWRAP_WACS_WACS_SYNC_IDLE 0x01
48 #define PWRAP_WACS_SYNC_BUSY 0x00
50 /* macro for device wrapper default value */
51 #define PWRAP_DEW_READ_TEST_VAL 0x5aa5
52 #define PWRAP_DEW_WRITE_TEST_VAL 0xa55a
54 /* macro for manual command */
55 #define PWRAP_MAN_CMD_SPI_WRITE_NEW (1 << 14)
56 #define PWRAP_MAN_CMD_SPI_WRITE (1 << 13)
57 #define PWRAP_MAN_CMD_OP_CSH (0x0 << 8)
58 #define PWRAP_MAN_CMD_OP_CSL (0x1 << 8)
59 #define PWRAP_MAN_CMD_OP_CK (0x2 << 8)
60 #define PWRAP_MAN_CMD_OP_OUTS (0x8 << 8)
61 #define PWRAP_MAN_CMD_OP_OUTD (0x9 << 8)
62 #define PWRAP_MAN_CMD_OP_OUTQ (0xa << 8)
64 /* macro for Watch Dog Timer Source */
65 #define PWRAP_WDT_SRC_EN_STAUPD_TRIG (1 << 25)
66 #define PWRAP_WDT_SRC_EN_HARB_STAUPD_DLE (1 << 20)
67 #define PWRAP_WDT_SRC_EN_HARB_STAUPD_ALE (1 << 6)
68 #define PWRAP_WDT_SRC_MASK_ALL 0xffffffff
69 #define PWRAP_WDT_SRC_MASK_NO_STAUPD ~(PWRAP_WDT_SRC_EN_STAUPD_TRIG | \
70 PWRAP_WDT_SRC_EN_HARB_STAUPD_DLE | \
71 PWRAP_WDT_SRC_EN_HARB_STAUPD_ALE)
73 /* defines for slave device wrapper registers */
81 PWRAP_DEW_MON_GRP_SEL
,
82 PWRAP_DEW_CIPHER_KEY_SEL
,
83 PWRAP_DEW_CIPHER_IV_SEL
,
85 PWRAP_DEW_CIPHER_MODE
,
86 PWRAP_DEW_CIPHER_SWRST
,
88 /* MT6397 only regs */
89 PWRAP_DEW_EVENT_OUT_EN
,
90 PWRAP_DEW_EVENT_SRC_EN
,
93 PWRAP_DEW_MON_FLAG_SEL
,
95 PWRAP_DEW_CIPHER_LOAD
,
96 PWRAP_DEW_CIPHER_START
,
98 /* MT6323 only regs */
103 static const u32 mt6323_regs
[] = {
104 [PWRAP_DEW_BASE
] = 0x0000,
105 [PWRAP_DEW_DIO_EN
] = 0x018a,
106 [PWRAP_DEW_READ_TEST
] = 0x018c,
107 [PWRAP_DEW_WRITE_TEST
] = 0x018e,
108 [PWRAP_DEW_CRC_EN
] = 0x0192,
109 [PWRAP_DEW_CRC_VAL
] = 0x0194,
110 [PWRAP_DEW_MON_GRP_SEL
] = 0x0196,
111 [PWRAP_DEW_CIPHER_KEY_SEL
] = 0x0198,
112 [PWRAP_DEW_CIPHER_IV_SEL
] = 0x019a,
113 [PWRAP_DEW_CIPHER_EN
] = 0x019c,
114 [PWRAP_DEW_CIPHER_RDY
] = 0x019e,
115 [PWRAP_DEW_CIPHER_MODE
] = 0x01a0,
116 [PWRAP_DEW_CIPHER_SWRST
] = 0x01a2,
117 [PWRAP_DEW_RDDMY_NO
] = 0x01a4,
120 static const u32 mt6397_regs
[] = {
121 [PWRAP_DEW_BASE
] = 0xbc00,
122 [PWRAP_DEW_EVENT_OUT_EN
] = 0xbc00,
123 [PWRAP_DEW_DIO_EN
] = 0xbc02,
124 [PWRAP_DEW_EVENT_SRC_EN
] = 0xbc04,
125 [PWRAP_DEW_EVENT_SRC
] = 0xbc06,
126 [PWRAP_DEW_EVENT_FLAG
] = 0xbc08,
127 [PWRAP_DEW_READ_TEST
] = 0xbc0a,
128 [PWRAP_DEW_WRITE_TEST
] = 0xbc0c,
129 [PWRAP_DEW_CRC_EN
] = 0xbc0e,
130 [PWRAP_DEW_CRC_VAL
] = 0xbc10,
131 [PWRAP_DEW_MON_GRP_SEL
] = 0xbc12,
132 [PWRAP_DEW_MON_FLAG_SEL
] = 0xbc14,
133 [PWRAP_DEW_EVENT_TEST
] = 0xbc16,
134 [PWRAP_DEW_CIPHER_KEY_SEL
] = 0xbc18,
135 [PWRAP_DEW_CIPHER_IV_SEL
] = 0xbc1a,
136 [PWRAP_DEW_CIPHER_LOAD
] = 0xbc1c,
137 [PWRAP_DEW_CIPHER_START
] = 0xbc1e,
138 [PWRAP_DEW_CIPHER_RDY
] = 0xbc20,
139 [PWRAP_DEW_CIPHER_MODE
] = 0xbc22,
140 [PWRAP_DEW_CIPHER_SWRST
] = 0xbc24,
154 PWRAP_STAUPD_MAN_TRIG
,
196 PWRAP_CIPHER_KEY_SEL
,
204 /* MT2701 only regs */
208 PWRAP_ADC_RDATA_ADDR1
,
209 PWRAP_ADC_RDATA_ADDR2
,
211 /* MT8135 only regs */
224 /* MT8173 only regs */
247 static int mt2701_regs
[] = {
248 [PWRAP_MUX_SEL
] = 0x0,
249 [PWRAP_WRAP_EN
] = 0x4,
250 [PWRAP_DIO_EN
] = 0x8,
252 [PWRAP_RDDMY
] = 0x18,
253 [PWRAP_SI_CK_CON
] = 0x1c,
254 [PWRAP_CSHEXT_WRITE
] = 0x20,
255 [PWRAP_CSHEXT_READ
] = 0x24,
256 [PWRAP_CSLEXT_START
] = 0x28,
257 [PWRAP_CSLEXT_END
] = 0x2c,
258 [PWRAP_STAUPD_PRD
] = 0x30,
259 [PWRAP_STAUPD_GRPEN
] = 0x34,
260 [PWRAP_STAUPD_MAN_TRIG
] = 0x38,
261 [PWRAP_STAUPD_STA
] = 0x3c,
262 [PWRAP_WRAP_STA
] = 0x44,
263 [PWRAP_HARB_INIT
] = 0x48,
264 [PWRAP_HARB_HPRIO
] = 0x4c,
265 [PWRAP_HIPRIO_ARB_EN
] = 0x50,
266 [PWRAP_HARB_STA0
] = 0x54,
267 [PWRAP_HARB_STA1
] = 0x58,
268 [PWRAP_MAN_EN
] = 0x5c,
269 [PWRAP_MAN_CMD
] = 0x60,
270 [PWRAP_MAN_RDATA
] = 0x64,
271 [PWRAP_MAN_VLDCLR
] = 0x68,
272 [PWRAP_WACS0_EN
] = 0x6c,
273 [PWRAP_INIT_DONE0
] = 0x70,
274 [PWRAP_WACS0_CMD
] = 0x74,
275 [PWRAP_WACS0_RDATA
] = 0x78,
276 [PWRAP_WACS0_VLDCLR
] = 0x7c,
277 [PWRAP_WACS1_EN
] = 0x80,
278 [PWRAP_INIT_DONE1
] = 0x84,
279 [PWRAP_WACS1_CMD
] = 0x88,
280 [PWRAP_WACS1_RDATA
] = 0x8c,
281 [PWRAP_WACS1_VLDCLR
] = 0x90,
282 [PWRAP_WACS2_EN
] = 0x94,
283 [PWRAP_INIT_DONE2
] = 0x98,
284 [PWRAP_WACS2_CMD
] = 0x9c,
285 [PWRAP_WACS2_RDATA
] = 0xa0,
286 [PWRAP_WACS2_VLDCLR
] = 0xa4,
287 [PWRAP_INT_EN
] = 0xa8,
288 [PWRAP_INT_FLG_RAW
] = 0xac,
289 [PWRAP_INT_FLG
] = 0xb0,
290 [PWRAP_INT_CLR
] = 0xb4,
291 [PWRAP_SIG_ADR
] = 0xb8,
292 [PWRAP_SIG_MODE
] = 0xbc,
293 [PWRAP_SIG_VALUE
] = 0xc0,
294 [PWRAP_SIG_ERRVAL
] = 0xc4,
295 [PWRAP_CRC_EN
] = 0xc8,
296 [PWRAP_TIMER_EN
] = 0xcc,
297 [PWRAP_TIMER_STA
] = 0xd0,
298 [PWRAP_WDT_UNIT
] = 0xd4,
299 [PWRAP_WDT_SRC_EN
] = 0xd8,
300 [PWRAP_WDT_FLG
] = 0xdc,
301 [PWRAP_DEBUG_INT_SEL
] = 0xe0,
302 [PWRAP_DVFS_ADR0
] = 0xe4,
303 [PWRAP_DVFS_WDATA0
] = 0xe8,
304 [PWRAP_DVFS_ADR1
] = 0xec,
305 [PWRAP_DVFS_WDATA1
] = 0xf0,
306 [PWRAP_DVFS_ADR2
] = 0xf4,
307 [PWRAP_DVFS_WDATA2
] = 0xf8,
308 [PWRAP_DVFS_ADR3
] = 0xfc,
309 [PWRAP_DVFS_WDATA3
] = 0x100,
310 [PWRAP_DVFS_ADR4
] = 0x104,
311 [PWRAP_DVFS_WDATA4
] = 0x108,
312 [PWRAP_DVFS_ADR5
] = 0x10c,
313 [PWRAP_DVFS_WDATA5
] = 0x110,
314 [PWRAP_DVFS_ADR6
] = 0x114,
315 [PWRAP_DVFS_WDATA6
] = 0x118,
316 [PWRAP_DVFS_ADR7
] = 0x11c,
317 [PWRAP_DVFS_WDATA7
] = 0x120,
318 [PWRAP_CIPHER_KEY_SEL
] = 0x124,
319 [PWRAP_CIPHER_IV_SEL
] = 0x128,
320 [PWRAP_CIPHER_EN
] = 0x12c,
321 [PWRAP_CIPHER_RDY
] = 0x130,
322 [PWRAP_CIPHER_MODE
] = 0x134,
323 [PWRAP_CIPHER_SWRST
] = 0x138,
324 [PWRAP_DCM_EN
] = 0x13c,
325 [PWRAP_DCM_DBC_PRD
] = 0x140,
326 [PWRAP_ADC_CMD_ADDR
] = 0x144,
327 [PWRAP_PWRAP_ADC_CMD
] = 0x148,
328 [PWRAP_ADC_RDY_ADDR
] = 0x14c,
329 [PWRAP_ADC_RDATA_ADDR1
] = 0x150,
330 [PWRAP_ADC_RDATA_ADDR2
] = 0x154,
333 static int mt8173_regs
[] = {
334 [PWRAP_MUX_SEL
] = 0x0,
335 [PWRAP_WRAP_EN
] = 0x4,
336 [PWRAP_DIO_EN
] = 0x8,
338 [PWRAP_RDDMY
] = 0x10,
339 [PWRAP_SI_CK_CON
] = 0x14,
340 [PWRAP_CSHEXT_WRITE
] = 0x18,
341 [PWRAP_CSHEXT_READ
] = 0x1c,
342 [PWRAP_CSLEXT_START
] = 0x20,
343 [PWRAP_CSLEXT_END
] = 0x24,
344 [PWRAP_STAUPD_PRD
] = 0x28,
345 [PWRAP_STAUPD_GRPEN
] = 0x2c,
346 [PWRAP_STAUPD_MAN_TRIG
] = 0x40,
347 [PWRAP_STAUPD_STA
] = 0x44,
348 [PWRAP_WRAP_STA
] = 0x48,
349 [PWRAP_HARB_INIT
] = 0x4c,
350 [PWRAP_HARB_HPRIO
] = 0x50,
351 [PWRAP_HIPRIO_ARB_EN
] = 0x54,
352 [PWRAP_HARB_STA0
] = 0x58,
353 [PWRAP_HARB_STA1
] = 0x5c,
354 [PWRAP_MAN_EN
] = 0x60,
355 [PWRAP_MAN_CMD
] = 0x64,
356 [PWRAP_MAN_RDATA
] = 0x68,
357 [PWRAP_MAN_VLDCLR
] = 0x6c,
358 [PWRAP_WACS0_EN
] = 0x70,
359 [PWRAP_INIT_DONE0
] = 0x74,
360 [PWRAP_WACS0_CMD
] = 0x78,
361 [PWRAP_WACS0_RDATA
] = 0x7c,
362 [PWRAP_WACS0_VLDCLR
] = 0x80,
363 [PWRAP_WACS1_EN
] = 0x84,
364 [PWRAP_INIT_DONE1
] = 0x88,
365 [PWRAP_WACS1_CMD
] = 0x8c,
366 [PWRAP_WACS1_RDATA
] = 0x90,
367 [PWRAP_WACS1_VLDCLR
] = 0x94,
368 [PWRAP_WACS2_EN
] = 0x98,
369 [PWRAP_INIT_DONE2
] = 0x9c,
370 [PWRAP_WACS2_CMD
] = 0xa0,
371 [PWRAP_WACS2_RDATA
] = 0xa4,
372 [PWRAP_WACS2_VLDCLR
] = 0xa8,
373 [PWRAP_INT_EN
] = 0xac,
374 [PWRAP_INT_FLG_RAW
] = 0xb0,
375 [PWRAP_INT_FLG
] = 0xb4,
376 [PWRAP_INT_CLR
] = 0xb8,
377 [PWRAP_SIG_ADR
] = 0xbc,
378 [PWRAP_SIG_MODE
] = 0xc0,
379 [PWRAP_SIG_VALUE
] = 0xc4,
380 [PWRAP_SIG_ERRVAL
] = 0xc8,
381 [PWRAP_CRC_EN
] = 0xcc,
382 [PWRAP_TIMER_EN
] = 0xd0,
383 [PWRAP_TIMER_STA
] = 0xd4,
384 [PWRAP_WDT_UNIT
] = 0xd8,
385 [PWRAP_WDT_SRC_EN
] = 0xdc,
386 [PWRAP_WDT_FLG
] = 0xe0,
387 [PWRAP_DEBUG_INT_SEL
] = 0xe4,
388 [PWRAP_DVFS_ADR0
] = 0xe8,
389 [PWRAP_DVFS_WDATA0
] = 0xec,
390 [PWRAP_DVFS_ADR1
] = 0xf0,
391 [PWRAP_DVFS_WDATA1
] = 0xf4,
392 [PWRAP_DVFS_ADR2
] = 0xf8,
393 [PWRAP_DVFS_WDATA2
] = 0xfc,
394 [PWRAP_DVFS_ADR3
] = 0x100,
395 [PWRAP_DVFS_WDATA3
] = 0x104,
396 [PWRAP_DVFS_ADR4
] = 0x108,
397 [PWRAP_DVFS_WDATA4
] = 0x10c,
398 [PWRAP_DVFS_ADR5
] = 0x110,
399 [PWRAP_DVFS_WDATA5
] = 0x114,
400 [PWRAP_DVFS_ADR6
] = 0x118,
401 [PWRAP_DVFS_WDATA6
] = 0x11c,
402 [PWRAP_DVFS_ADR7
] = 0x120,
403 [PWRAP_DVFS_WDATA7
] = 0x124,
404 [PWRAP_SPMINF_STA
] = 0x128,
405 [PWRAP_CIPHER_KEY_SEL
] = 0x12c,
406 [PWRAP_CIPHER_IV_SEL
] = 0x130,
407 [PWRAP_CIPHER_EN
] = 0x134,
408 [PWRAP_CIPHER_RDY
] = 0x138,
409 [PWRAP_CIPHER_MODE
] = 0x13c,
410 [PWRAP_CIPHER_SWRST
] = 0x140,
411 [PWRAP_DCM_EN
] = 0x144,
412 [PWRAP_DCM_DBC_PRD
] = 0x148,
415 static int mt8135_regs
[] = {
416 [PWRAP_MUX_SEL
] = 0x0,
417 [PWRAP_WRAP_EN
] = 0x4,
418 [PWRAP_DIO_EN
] = 0x8,
420 [PWRAP_CSHEXT
] = 0x10,
421 [PWRAP_CSHEXT_WRITE
] = 0x14,
422 [PWRAP_CSHEXT_READ
] = 0x18,
423 [PWRAP_CSLEXT_START
] = 0x1c,
424 [PWRAP_CSLEXT_END
] = 0x20,
425 [PWRAP_STAUPD_PRD
] = 0x24,
426 [PWRAP_STAUPD_GRPEN
] = 0x28,
427 [PWRAP_STAUPD_MAN_TRIG
] = 0x2c,
428 [PWRAP_STAUPD_STA
] = 0x30,
429 [PWRAP_EVENT_IN_EN
] = 0x34,
430 [PWRAP_EVENT_DST_EN
] = 0x38,
431 [PWRAP_WRAP_STA
] = 0x3c,
432 [PWRAP_RRARB_INIT
] = 0x40,
433 [PWRAP_RRARB_EN
] = 0x44,
434 [PWRAP_RRARB_STA0
] = 0x48,
435 [PWRAP_RRARB_STA1
] = 0x4c,
436 [PWRAP_HARB_INIT
] = 0x50,
437 [PWRAP_HARB_HPRIO
] = 0x54,
438 [PWRAP_HIPRIO_ARB_EN
] = 0x58,
439 [PWRAP_HARB_STA0
] = 0x5c,
440 [PWRAP_HARB_STA1
] = 0x60,
441 [PWRAP_MAN_EN
] = 0x64,
442 [PWRAP_MAN_CMD
] = 0x68,
443 [PWRAP_MAN_RDATA
] = 0x6c,
444 [PWRAP_MAN_VLDCLR
] = 0x70,
445 [PWRAP_WACS0_EN
] = 0x74,
446 [PWRAP_INIT_DONE0
] = 0x78,
447 [PWRAP_WACS0_CMD
] = 0x7c,
448 [PWRAP_WACS0_RDATA
] = 0x80,
449 [PWRAP_WACS0_VLDCLR
] = 0x84,
450 [PWRAP_WACS1_EN
] = 0x88,
451 [PWRAP_INIT_DONE1
] = 0x8c,
452 [PWRAP_WACS1_CMD
] = 0x90,
453 [PWRAP_WACS1_RDATA
] = 0x94,
454 [PWRAP_WACS1_VLDCLR
] = 0x98,
455 [PWRAP_WACS2_EN
] = 0x9c,
456 [PWRAP_INIT_DONE2
] = 0xa0,
457 [PWRAP_WACS2_CMD
] = 0xa4,
458 [PWRAP_WACS2_RDATA
] = 0xa8,
459 [PWRAP_WACS2_VLDCLR
] = 0xac,
460 [PWRAP_INT_EN
] = 0xb0,
461 [PWRAP_INT_FLG_RAW
] = 0xb4,
462 [PWRAP_INT_FLG
] = 0xb8,
463 [PWRAP_INT_CLR
] = 0xbc,
464 [PWRAP_SIG_ADR
] = 0xc0,
465 [PWRAP_SIG_MODE
] = 0xc4,
466 [PWRAP_SIG_VALUE
] = 0xc8,
467 [PWRAP_SIG_ERRVAL
] = 0xcc,
468 [PWRAP_CRC_EN
] = 0xd0,
469 [PWRAP_EVENT_STA
] = 0xd4,
470 [PWRAP_EVENT_STACLR
] = 0xd8,
471 [PWRAP_TIMER_EN
] = 0xdc,
472 [PWRAP_TIMER_STA
] = 0xe0,
473 [PWRAP_WDT_UNIT
] = 0xe4,
474 [PWRAP_WDT_SRC_EN
] = 0xe8,
475 [PWRAP_WDT_FLG
] = 0xec,
476 [PWRAP_DEBUG_INT_SEL
] = 0xf0,
477 [PWRAP_CIPHER_KEY_SEL
] = 0x134,
478 [PWRAP_CIPHER_IV_SEL
] = 0x138,
479 [PWRAP_CIPHER_LOAD
] = 0x13c,
480 [PWRAP_CIPHER_START
] = 0x140,
481 [PWRAP_CIPHER_RDY
] = 0x144,
482 [PWRAP_CIPHER_MODE
] = 0x148,
483 [PWRAP_CIPHER_SWRST
] = 0x14c,
484 [PWRAP_DCM_EN
] = 0x15c,
485 [PWRAP_DCM_DBC_PRD
] = 0x160,
499 struct pwrap_slv_type
{
504 struct pmic_wrapper
{
507 struct regmap
*regmap
;
508 const struct pmic_wrapper_type
*master
;
509 const struct pwrap_slv_type
*slave
;
511 struct clk
*clk_wrap
;
512 struct reset_control
*rstc
;
514 struct reset_control
*rstc_bridge
;
515 void __iomem
*bridge_base
;
518 struct pmic_wrapper_type
{
520 enum pwrap_type type
;
526 int (*init_reg_clock
)(struct pmic_wrapper
*wrp
);
527 int (*init_soc_specific
)(struct pmic_wrapper
*wrp
);
530 static u32
pwrap_readl(struct pmic_wrapper
*wrp
, enum pwrap_regs reg
)
532 return readl(wrp
->base
+ wrp
->master
->regs
[reg
]);
535 static void pwrap_writel(struct pmic_wrapper
*wrp
, u32 val
, enum pwrap_regs reg
)
537 writel(val
, wrp
->base
+ wrp
->master
->regs
[reg
]);
540 static bool pwrap_is_fsm_idle(struct pmic_wrapper
*wrp
)
542 u32 val
= pwrap_readl(wrp
, PWRAP_WACS2_RDATA
);
544 return PWRAP_GET_WACS_FSM(val
) == PWRAP_WACS_FSM_IDLE
;
547 static bool pwrap_is_fsm_vldclr(struct pmic_wrapper
*wrp
)
549 u32 val
= pwrap_readl(wrp
, PWRAP_WACS2_RDATA
);
551 return PWRAP_GET_WACS_FSM(val
) == PWRAP_WACS_FSM_WFVLDCLR
;
555 * Timeout issue sometimes caused by the last read command
556 * failed because pmic wrap could not got the FSM_VLDCLR
557 * in time after finishing WACS2_CMD. It made state machine
558 * still on FSM_VLDCLR and timeout next time.
559 * Check the status of FSM and clear the vldclr to recovery the
562 static inline void pwrap_leave_fsm_vldclr(struct pmic_wrapper
*wrp
)
564 if (pwrap_is_fsm_vldclr(wrp
))
565 pwrap_writel(wrp
, 1, PWRAP_WACS2_VLDCLR
);
568 static bool pwrap_is_sync_idle(struct pmic_wrapper
*wrp
)
570 return pwrap_readl(wrp
, PWRAP_WACS2_RDATA
) & PWRAP_STATE_SYNC_IDLE0
;
573 static bool pwrap_is_fsm_idle_and_sync_idle(struct pmic_wrapper
*wrp
)
575 u32 val
= pwrap_readl(wrp
, PWRAP_WACS2_RDATA
);
577 return (PWRAP_GET_WACS_FSM(val
) == PWRAP_WACS_FSM_IDLE
) &&
578 (val
& PWRAP_STATE_SYNC_IDLE0
);
581 static int pwrap_wait_for_state(struct pmic_wrapper
*wrp
,
582 bool (*fp
)(struct pmic_wrapper
*))
584 unsigned long timeout
;
586 timeout
= jiffies
+ usecs_to_jiffies(10000);
589 if (time_after(jiffies
, timeout
))
590 return fp(wrp
) ? 0 : -ETIMEDOUT
;
596 static int pwrap_write(struct pmic_wrapper
*wrp
, u32 adr
, u32 wdata
)
600 ret
= pwrap_wait_for_state(wrp
, pwrap_is_fsm_idle
);
602 pwrap_leave_fsm_vldclr(wrp
);
606 pwrap_writel(wrp
, (1 << 31) | ((adr
>> 1) << 16) | wdata
,
612 static int pwrap_read(struct pmic_wrapper
*wrp
, u32 adr
, u32
*rdata
)
616 ret
= pwrap_wait_for_state(wrp
, pwrap_is_fsm_idle
);
618 pwrap_leave_fsm_vldclr(wrp
);
622 pwrap_writel(wrp
, (adr
>> 1) << 16, PWRAP_WACS2_CMD
);
624 ret
= pwrap_wait_for_state(wrp
, pwrap_is_fsm_vldclr
);
628 *rdata
= PWRAP_GET_WACS_RDATA(pwrap_readl(wrp
, PWRAP_WACS2_RDATA
));
630 pwrap_writel(wrp
, 1, PWRAP_WACS2_VLDCLR
);
635 static int pwrap_regmap_read(void *context
, u32 adr
, u32
*rdata
)
637 return pwrap_read(context
, adr
, rdata
);
640 static int pwrap_regmap_write(void *context
, u32 adr
, u32 wdata
)
642 return pwrap_write(context
, adr
, wdata
);
645 static int pwrap_reset_spislave(struct pmic_wrapper
*wrp
)
649 pwrap_writel(wrp
, 0, PWRAP_HIPRIO_ARB_EN
);
650 pwrap_writel(wrp
, 0, PWRAP_WRAP_EN
);
651 pwrap_writel(wrp
, 1, PWRAP_MUX_SEL
);
652 pwrap_writel(wrp
, 1, PWRAP_MAN_EN
);
653 pwrap_writel(wrp
, 0, PWRAP_DIO_EN
);
655 pwrap_writel(wrp
, wrp
->master
->spi_w
| PWRAP_MAN_CMD_OP_CSL
,
657 pwrap_writel(wrp
, wrp
->master
->spi_w
| PWRAP_MAN_CMD_OP_OUTS
,
659 pwrap_writel(wrp
, wrp
->master
->spi_w
| PWRAP_MAN_CMD_OP_CSH
,
662 for (i
= 0; i
< 4; i
++)
663 pwrap_writel(wrp
, wrp
->master
->spi_w
| PWRAP_MAN_CMD_OP_OUTS
,
666 ret
= pwrap_wait_for_state(wrp
, pwrap_is_sync_idle
);
668 dev_err(wrp
->dev
, "%s fail, ret=%d\n", __func__
, ret
);
672 pwrap_writel(wrp
, 0, PWRAP_MAN_EN
);
673 pwrap_writel(wrp
, 0, PWRAP_MUX_SEL
);
679 * pwrap_init_sidly - configure serial input delay
681 * This configures the serial input delay. We can configure 0, 2, 4 or 6ns
682 * delay. Do a read test with all possible values and chose the best delay.
684 static int pwrap_init_sidly(struct pmic_wrapper
*wrp
)
689 signed char dly
[16] = {
690 -1, 0, 1, 0, 2, -1, 1, 1, 3, -1, -1, -1, 3, -1, 2, 1
693 for (i
= 0; i
< 4; i
++) {
694 pwrap_writel(wrp
, i
, PWRAP_SIDLY
);
695 pwrap_read(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_READ_TEST
],
697 if (rdata
== PWRAP_DEW_READ_TEST_VAL
) {
698 dev_dbg(wrp
->dev
, "[Read Test] pass, SIDLY=%x\n", i
);
704 dev_err(wrp
->dev
, "sidly pass range 0x%x not continuous\n",
709 pwrap_writel(wrp
, dly
[pass
], PWRAP_SIDLY
);
714 static int pwrap_mt8135_init_reg_clock(struct pmic_wrapper
*wrp
)
716 pwrap_writel(wrp
, 0x4, PWRAP_CSHEXT
);
717 pwrap_writel(wrp
, 0x0, PWRAP_CSHEXT_WRITE
);
718 pwrap_writel(wrp
, 0x4, PWRAP_CSHEXT_READ
);
719 pwrap_writel(wrp
, 0x0, PWRAP_CSLEXT_START
);
720 pwrap_writel(wrp
, 0x0, PWRAP_CSLEXT_END
);
725 static int pwrap_mt8173_init_reg_clock(struct pmic_wrapper
*wrp
)
727 pwrap_writel(wrp
, 0x0, PWRAP_CSHEXT_WRITE
);
728 pwrap_writel(wrp
, 0x4, PWRAP_CSHEXT_READ
);
729 pwrap_writel(wrp
, 0x2, PWRAP_CSLEXT_START
);
730 pwrap_writel(wrp
, 0x2, PWRAP_CSLEXT_END
);
735 static int pwrap_mt2701_init_reg_clock(struct pmic_wrapper
*wrp
)
737 switch (wrp
->slave
->type
) {
739 pwrap_writel(wrp
, 0xc, PWRAP_RDDMY
);
740 pwrap_writel(wrp
, 0x4, PWRAP_CSHEXT_WRITE
);
741 pwrap_writel(wrp
, 0x0, PWRAP_CSHEXT_READ
);
742 pwrap_writel(wrp
, 0x2, PWRAP_CSLEXT_START
);
743 pwrap_writel(wrp
, 0x2, PWRAP_CSLEXT_END
);
747 pwrap_writel(wrp
, 0x8, PWRAP_RDDMY
);
748 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_RDDMY_NO
],
750 pwrap_writel(wrp
, 0x5, PWRAP_CSHEXT_WRITE
);
751 pwrap_writel(wrp
, 0x0, PWRAP_CSHEXT_READ
);
752 pwrap_writel(wrp
, 0x2, PWRAP_CSLEXT_START
);
753 pwrap_writel(wrp
, 0x2, PWRAP_CSLEXT_END
);
760 static bool pwrap_is_cipher_ready(struct pmic_wrapper
*wrp
)
762 return pwrap_readl(wrp
, PWRAP_CIPHER_RDY
) & 1;
765 static bool pwrap_is_pmic_cipher_ready(struct pmic_wrapper
*wrp
)
770 ret
= pwrap_read(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CIPHER_RDY
],
778 static int pwrap_init_cipher(struct pmic_wrapper
*wrp
)
783 pwrap_writel(wrp
, 0x1, PWRAP_CIPHER_SWRST
);
784 pwrap_writel(wrp
, 0x0, PWRAP_CIPHER_SWRST
);
785 pwrap_writel(wrp
, 0x1, PWRAP_CIPHER_KEY_SEL
);
786 pwrap_writel(wrp
, 0x2, PWRAP_CIPHER_IV_SEL
);
788 switch (wrp
->master
->type
) {
790 pwrap_writel(wrp
, 1, PWRAP_CIPHER_LOAD
);
791 pwrap_writel(wrp
, 1, PWRAP_CIPHER_START
);
795 pwrap_writel(wrp
, 1, PWRAP_CIPHER_EN
);
799 /* Config cipher mode @PMIC */
800 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CIPHER_SWRST
], 0x1);
801 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CIPHER_SWRST
], 0x0);
802 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CIPHER_KEY_SEL
], 0x1);
803 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CIPHER_IV_SEL
], 0x2);
804 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CIPHER_LOAD
], 0x1);
805 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CIPHER_START
], 0x1);
807 switch (wrp
->slave
->type
) {
809 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CIPHER_LOAD
],
811 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CIPHER_START
],
815 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CIPHER_EN
],
820 /* wait for cipher data ready@AP */
821 ret
= pwrap_wait_for_state(wrp
, pwrap_is_cipher_ready
);
823 dev_err(wrp
->dev
, "cipher data ready@AP fail, ret=%d\n", ret
);
827 /* wait for cipher data ready@PMIC */
828 ret
= pwrap_wait_for_state(wrp
, pwrap_is_pmic_cipher_ready
);
830 dev_err(wrp
->dev
, "timeout waiting for cipher data ready@PMIC\n");
834 /* wait for cipher mode idle */
835 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CIPHER_MODE
], 0x1);
836 ret
= pwrap_wait_for_state(wrp
, pwrap_is_fsm_idle_and_sync_idle
);
838 dev_err(wrp
->dev
, "cipher mode idle fail, ret=%d\n", ret
);
842 pwrap_writel(wrp
, 1, PWRAP_CIPHER_MODE
);
845 if (pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_WRITE_TEST
],
846 PWRAP_DEW_WRITE_TEST_VAL
) ||
847 pwrap_read(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_WRITE_TEST
],
849 (rdata
!= PWRAP_DEW_WRITE_TEST_VAL
)) {
850 dev_err(wrp
->dev
, "rdata=0x%04X\n", rdata
);
857 static int pwrap_mt8135_init_soc_specific(struct pmic_wrapper
*wrp
)
859 /* enable pwrap events and pwrap bridge in AP side */
860 pwrap_writel(wrp
, 0x1, PWRAP_EVENT_IN_EN
);
861 pwrap_writel(wrp
, 0xffff, PWRAP_EVENT_DST_EN
);
862 writel(0x7f, wrp
->bridge_base
+ PWRAP_MT8135_BRIDGE_IORD_ARB_EN
);
863 writel(0x1, wrp
->bridge_base
+ PWRAP_MT8135_BRIDGE_WACS3_EN
);
864 writel(0x1, wrp
->bridge_base
+ PWRAP_MT8135_BRIDGE_WACS4_EN
);
865 writel(0x1, wrp
->bridge_base
+ PWRAP_MT8135_BRIDGE_WDT_UNIT
);
866 writel(0xffff, wrp
->bridge_base
+ PWRAP_MT8135_BRIDGE_WDT_SRC_EN
);
867 writel(0x1, wrp
->bridge_base
+ PWRAP_MT8135_BRIDGE_TIMER_EN
);
868 writel(0x7ff, wrp
->bridge_base
+ PWRAP_MT8135_BRIDGE_INT_EN
);
870 /* enable PMIC event out and sources */
871 if (pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_EVENT_OUT_EN
],
873 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_EVENT_SRC_EN
],
875 dev_err(wrp
->dev
, "enable dewrap fail\n");
882 static int pwrap_mt8173_init_soc_specific(struct pmic_wrapper
*wrp
)
884 /* PMIC_DEWRAP enables */
885 if (pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_EVENT_OUT_EN
],
887 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_EVENT_SRC_EN
],
889 dev_err(wrp
->dev
, "enable dewrap fail\n");
896 static int pwrap_mt2701_init_soc_specific(struct pmic_wrapper
*wrp
)
898 /* GPS_INTF initialization */
899 switch (wrp
->slave
->type
) {
901 pwrap_writel(wrp
, 0x076c, PWRAP_ADC_CMD_ADDR
);
902 pwrap_writel(wrp
, 0x8000, PWRAP_PWRAP_ADC_CMD
);
903 pwrap_writel(wrp
, 0x072c, PWRAP_ADC_RDY_ADDR
);
904 pwrap_writel(wrp
, 0x072e, PWRAP_ADC_RDATA_ADDR1
);
905 pwrap_writel(wrp
, 0x0730, PWRAP_ADC_RDATA_ADDR2
);
914 static int pwrap_init(struct pmic_wrapper
*wrp
)
919 reset_control_reset(wrp
->rstc
);
920 if (wrp
->rstc_bridge
)
921 reset_control_reset(wrp
->rstc_bridge
);
923 if (wrp
->master
->type
== PWRAP_MT8173
) {
925 pwrap_writel(wrp
, 3, PWRAP_DCM_EN
);
926 pwrap_writel(wrp
, 0, PWRAP_DCM_DBC_PRD
);
929 /* Reset SPI slave */
930 ret
= pwrap_reset_spislave(wrp
);
934 pwrap_writel(wrp
, 1, PWRAP_WRAP_EN
);
936 pwrap_writel(wrp
, wrp
->master
->arb_en_all
, PWRAP_HIPRIO_ARB_EN
);
938 pwrap_writel(wrp
, 1, PWRAP_WACS2_EN
);
940 ret
= wrp
->master
->init_reg_clock(wrp
);
944 /* Setup serial input delay */
945 ret
= pwrap_init_sidly(wrp
);
949 /* Enable dual IO mode */
950 pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_DIO_EN
], 1);
952 /* Check IDLE & INIT_DONE in advance */
953 ret
= pwrap_wait_for_state(wrp
, pwrap_is_fsm_idle_and_sync_idle
);
955 dev_err(wrp
->dev
, "%s fail, ret=%d\n", __func__
, ret
);
959 pwrap_writel(wrp
, 1, PWRAP_DIO_EN
);
962 pwrap_read(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_READ_TEST
], &rdata
);
963 if (rdata
!= PWRAP_DEW_READ_TEST_VAL
) {
964 dev_err(wrp
->dev
, "Read test failed after switch to DIO mode: 0x%04x != 0x%04x\n",
965 PWRAP_DEW_READ_TEST_VAL
, rdata
);
969 /* Enable encryption */
970 ret
= pwrap_init_cipher(wrp
);
974 /* Signature checking - using CRC */
975 if (pwrap_write(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CRC_EN
], 0x1))
978 pwrap_writel(wrp
, 0x1, PWRAP_CRC_EN
);
979 pwrap_writel(wrp
, 0x0, PWRAP_SIG_MODE
);
980 pwrap_writel(wrp
, wrp
->slave
->dew_regs
[PWRAP_DEW_CRC_VAL
],
982 pwrap_writel(wrp
, wrp
->master
->arb_en_all
, PWRAP_HIPRIO_ARB_EN
);
984 if (wrp
->master
->type
== PWRAP_MT8135
)
985 pwrap_writel(wrp
, 0x7, PWRAP_RRARB_EN
);
987 pwrap_writel(wrp
, 0x1, PWRAP_WACS0_EN
);
988 pwrap_writel(wrp
, 0x1, PWRAP_WACS1_EN
);
989 pwrap_writel(wrp
, 0x1, PWRAP_WACS2_EN
);
990 pwrap_writel(wrp
, 0x5, PWRAP_STAUPD_PRD
);
991 pwrap_writel(wrp
, 0xff, PWRAP_STAUPD_GRPEN
);
993 if (wrp
->master
->init_soc_specific
) {
994 ret
= wrp
->master
->init_soc_specific(wrp
);
999 /* Setup the init done registers */
1000 pwrap_writel(wrp
, 1, PWRAP_INIT_DONE2
);
1001 pwrap_writel(wrp
, 1, PWRAP_INIT_DONE0
);
1002 pwrap_writel(wrp
, 1, PWRAP_INIT_DONE1
);
1004 if (wrp
->master
->has_bridge
) {
1005 writel(1, wrp
->bridge_base
+ PWRAP_MT8135_BRIDGE_INIT_DONE3
);
1006 writel(1, wrp
->bridge_base
+ PWRAP_MT8135_BRIDGE_INIT_DONE4
);
1012 static irqreturn_t
pwrap_interrupt(int irqno
, void *dev_id
)
1015 struct pmic_wrapper
*wrp
= dev_id
;
1017 rdata
= pwrap_readl(wrp
, PWRAP_INT_FLG
);
1019 dev_err(wrp
->dev
, "unexpected interrupt int=0x%x\n", rdata
);
1021 pwrap_writel(wrp
, 0xffffffff, PWRAP_INT_CLR
);
1026 static const struct regmap_config pwrap_regmap_config
= {
1030 .reg_read
= pwrap_regmap_read
,
1031 .reg_write
= pwrap_regmap_write
,
1032 .max_register
= 0xffff,
1035 static const struct pwrap_slv_type pmic_mt6323
= {
1036 .dew_regs
= mt6323_regs
,
1037 .type
= PMIC_MT6323
,
1040 static const struct pwrap_slv_type pmic_mt6397
= {
1041 .dew_regs
= mt6397_regs
,
1042 .type
= PMIC_MT6397
,
1045 static const struct of_device_id of_slave_match_tbl
[] = {
1047 .compatible
= "mediatek,mt6323",
1048 .data
= &pmic_mt6323
,
1050 .compatible
= "mediatek,mt6397",
1051 .data
= &pmic_mt6397
,
1056 MODULE_DEVICE_TABLE(of
, of_slave_match_tbl
);
1058 static const struct pmic_wrapper_type pwrap_mt2701
= {
1059 .regs
= mt2701_regs
,
1060 .type
= PWRAP_MT2701
,
1062 .int_en_all
= ~(u32
)(BIT(31) | BIT(2)),
1063 .spi_w
= PWRAP_MAN_CMD_SPI_WRITE_NEW
,
1064 .wdt_src
= PWRAP_WDT_SRC_MASK_ALL
,
1066 .init_reg_clock
= pwrap_mt2701_init_reg_clock
,
1067 .init_soc_specific
= pwrap_mt2701_init_soc_specific
,
1070 static struct pmic_wrapper_type pwrap_mt8135
= {
1071 .regs
= mt8135_regs
,
1072 .type
= PWRAP_MT8135
,
1073 .arb_en_all
= 0x1ff,
1074 .int_en_all
= ~(u32
)(BIT(31) | BIT(1)),
1075 .spi_w
= PWRAP_MAN_CMD_SPI_WRITE
,
1076 .wdt_src
= PWRAP_WDT_SRC_MASK_ALL
,
1078 .init_reg_clock
= pwrap_mt8135_init_reg_clock
,
1079 .init_soc_specific
= pwrap_mt8135_init_soc_specific
,
1082 static struct pmic_wrapper_type pwrap_mt8173
= {
1083 .regs
= mt8173_regs
,
1084 .type
= PWRAP_MT8173
,
1086 .int_en_all
= ~(u32
)(BIT(31) | BIT(1)),
1087 .spi_w
= PWRAP_MAN_CMD_SPI_WRITE
,
1088 .wdt_src
= PWRAP_WDT_SRC_MASK_NO_STAUPD
,
1090 .init_reg_clock
= pwrap_mt8173_init_reg_clock
,
1091 .init_soc_specific
= pwrap_mt8173_init_soc_specific
,
1094 static struct of_device_id of_pwrap_match_tbl
[] = {
1096 .compatible
= "mediatek,mt2701-pwrap",
1097 .data
= &pwrap_mt2701
,
1099 .compatible
= "mediatek,mt8135-pwrap",
1100 .data
= &pwrap_mt8135
,
1102 .compatible
= "mediatek,mt8173-pwrap",
1103 .data
= &pwrap_mt8173
,
1108 MODULE_DEVICE_TABLE(of
, of_pwrap_match_tbl
);
1110 static int pwrap_probe(struct platform_device
*pdev
)
1113 struct pmic_wrapper
*wrp
;
1114 struct device_node
*np
= pdev
->dev
.of_node
;
1115 const struct of_device_id
*of_id
=
1116 of_match_device(of_pwrap_match_tbl
, &pdev
->dev
);
1117 const struct of_device_id
*of_slave_id
= NULL
;
1118 struct resource
*res
;
1120 if (pdev
->dev
.of_node
->child
)
1121 of_slave_id
= of_match_node(of_slave_match_tbl
,
1122 pdev
->dev
.of_node
->child
);
1124 dev_dbg(&pdev
->dev
, "slave pmic should be defined in dts\n");
1128 wrp
= devm_kzalloc(&pdev
->dev
, sizeof(*wrp
), GFP_KERNEL
);
1132 platform_set_drvdata(pdev
, wrp
);
1134 wrp
->master
= of_id
->data
;
1135 wrp
->slave
= of_slave_id
->data
;
1136 wrp
->dev
= &pdev
->dev
;
1138 res
= platform_get_resource_byname(pdev
, IORESOURCE_MEM
, "pwrap");
1139 wrp
->base
= devm_ioremap_resource(wrp
->dev
, res
);
1140 if (IS_ERR(wrp
->base
))
1141 return PTR_ERR(wrp
->base
);
1143 wrp
->rstc
= devm_reset_control_get(wrp
->dev
, "pwrap");
1144 if (IS_ERR(wrp
->rstc
)) {
1145 ret
= PTR_ERR(wrp
->rstc
);
1146 dev_dbg(wrp
->dev
, "cannot get pwrap reset: %d\n", ret
);
1150 if (wrp
->master
->has_bridge
) {
1151 res
= platform_get_resource_byname(pdev
, IORESOURCE_MEM
,
1153 wrp
->bridge_base
= devm_ioremap_resource(wrp
->dev
, res
);
1154 if (IS_ERR(wrp
->bridge_base
))
1155 return PTR_ERR(wrp
->bridge_base
);
1157 wrp
->rstc_bridge
= devm_reset_control_get(wrp
->dev
, "pwrap-bridge");
1158 if (IS_ERR(wrp
->rstc_bridge
)) {
1159 ret
= PTR_ERR(wrp
->rstc_bridge
);
1160 dev_dbg(wrp
->dev
, "cannot get pwrap-bridge reset: %d\n", ret
);
1165 wrp
->clk_spi
= devm_clk_get(wrp
->dev
, "spi");
1166 if (IS_ERR(wrp
->clk_spi
)) {
1167 dev_dbg(wrp
->dev
, "failed to get clock: %ld\n", PTR_ERR(wrp
->clk_spi
));
1168 return PTR_ERR(wrp
->clk_spi
);
1171 wrp
->clk_wrap
= devm_clk_get(wrp
->dev
, "wrap");
1172 if (IS_ERR(wrp
->clk_wrap
)) {
1173 dev_dbg(wrp
->dev
, "failed to get clock: %ld\n", PTR_ERR(wrp
->clk_wrap
));
1174 return PTR_ERR(wrp
->clk_wrap
);
1177 ret
= clk_prepare_enable(wrp
->clk_spi
);
1181 ret
= clk_prepare_enable(wrp
->clk_wrap
);
1185 /* Enable internal dynamic clock */
1186 pwrap_writel(wrp
, 1, PWRAP_DCM_EN
);
1187 pwrap_writel(wrp
, 0, PWRAP_DCM_DBC_PRD
);
1190 * The PMIC could already be initialized by the bootloader.
1191 * Skip initialization here in this case.
1193 if (!pwrap_readl(wrp
, PWRAP_INIT_DONE2
)) {
1194 ret
= pwrap_init(wrp
);
1196 dev_dbg(wrp
->dev
, "init failed with %d\n", ret
);
1201 if (!(pwrap_readl(wrp
, PWRAP_WACS2_RDATA
) & PWRAP_STATE_INIT_DONE0
)) {
1202 dev_dbg(wrp
->dev
, "initialization isn't finished\n");
1206 /* Initialize watchdog, may not be done by the bootloader */
1207 pwrap_writel(wrp
, 0xf, PWRAP_WDT_UNIT
);
1209 * Since STAUPD was not used on mt8173 platform,
1210 * so STAUPD of WDT_SRC which should be turned off
1212 pwrap_writel(wrp
, wrp
->master
->wdt_src
, PWRAP_WDT_SRC_EN
);
1213 pwrap_writel(wrp
, 0x1, PWRAP_TIMER_EN
);
1214 pwrap_writel(wrp
, wrp
->master
->int_en_all
, PWRAP_INT_EN
);
1216 irq
= platform_get_irq(pdev
, 0);
1217 ret
= devm_request_irq(wrp
->dev
, irq
, pwrap_interrupt
, IRQF_TRIGGER_HIGH
,
1218 "mt-pmic-pwrap", wrp
);
1222 wrp
->regmap
= devm_regmap_init(wrp
->dev
, NULL
, wrp
, &pwrap_regmap_config
);
1223 if (IS_ERR(wrp
->regmap
))
1224 return PTR_ERR(wrp
->regmap
);
1226 ret
= of_platform_populate(np
, NULL
, NULL
, wrp
->dev
);
1228 dev_dbg(wrp
->dev
, "failed to create child devices at %s\n",
1236 clk_disable_unprepare(wrp
->clk_wrap
);
1238 clk_disable_unprepare(wrp
->clk_spi
);
1243 static struct platform_driver pwrap_drv
= {
1245 .name
= "mt-pmic-pwrap",
1246 .of_match_table
= of_match_ptr(of_pwrap_match_tbl
),
1248 .probe
= pwrap_probe
,
1251 module_platform_driver(pwrap_drv
);
1253 MODULE_AUTHOR("Flora Fu, MediaTek");
1254 MODULE_DESCRIPTION("MediaTek MT8135 PMIC Wrapper Driver");
1255 MODULE_LICENSE("GPL v2");