xref: /arm-trusted-firmware/plat/mediatek/mt8186/drivers/mcdi/mt_lp_irqremain.c (revision 91f16700b400a8c0651d24a598fc48ee2997a0d7)
1*91f16700Schasinglulu /*
2*91f16700Schasinglulu  * Copyright (c) 2022, MediaTek Inc. All rights reserved.
3*91f16700Schasinglulu  *
4*91f16700Schasinglulu  * SPDX-License-Identifier: BSD-3-Clause
5*91f16700Schasinglulu  */
6*91f16700Schasinglulu 
7*91f16700Schasinglulu #include <mt_cirq.h>
8*91f16700Schasinglulu #include <mt_lp_irqremain.h>
9*91f16700Schasinglulu #include <mt_lp_rm.h>
10*91f16700Schasinglulu #include <plat_mtk_lpm.h>
11*91f16700Schasinglulu 
12*91f16700Schasinglulu #define KEYPAD_IRQ_ID		U(138)
13*91f16700Schasinglulu #define KEYPAD_WAKESRC		(0x4U)
14*91f16700Schasinglulu 
15*91f16700Schasinglulu static struct mt_irqremain remain_irqs;
16*91f16700Schasinglulu 
17*91f16700Schasinglulu int mt_lp_irqremain_submit(void)
18*91f16700Schasinglulu {
19*91f16700Schasinglulu 	int ret = 0;
20*91f16700Schasinglulu 
21*91f16700Schasinglulu 	if (remain_irqs.count == 0) {
22*91f16700Schasinglulu 		ret = -1;
23*91f16700Schasinglulu 	} else {
24*91f16700Schasinglulu 		set_wakeup_sources(remain_irqs.irqs, remain_irqs.count);
25*91f16700Schasinglulu 		mt_lp_rm_do_update(-1, PLAT_RC_UPDATE_REMAIN_IRQS, &remain_irqs);
26*91f16700Schasinglulu 	}
27*91f16700Schasinglulu 
28*91f16700Schasinglulu 	return ret;
29*91f16700Schasinglulu }
30*91f16700Schasinglulu 
31*91f16700Schasinglulu int mt_lp_irqremain_aquire(void)
32*91f16700Schasinglulu {
33*91f16700Schasinglulu 	int ret = 0;
34*91f16700Schasinglulu 
35*91f16700Schasinglulu 	if (remain_irqs.count == 0) {
36*91f16700Schasinglulu 		ret = -1;
37*91f16700Schasinglulu 	} else {
38*91f16700Schasinglulu 		mt_cirq_sw_reset();
39*91f16700Schasinglulu 		mt_cirq_clone_gic();
40*91f16700Schasinglulu 		mt_cirq_enable();
41*91f16700Schasinglulu 	}
42*91f16700Schasinglulu 
43*91f16700Schasinglulu 	return ret;
44*91f16700Schasinglulu }
45*91f16700Schasinglulu 
46*91f16700Schasinglulu int mt_lp_irqremain_release(void)
47*91f16700Schasinglulu {
48*91f16700Schasinglulu 	int ret = 0;
49*91f16700Schasinglulu 
50*91f16700Schasinglulu 	if (remain_irqs.count == 0) {
51*91f16700Schasinglulu 		ret = -1;
52*91f16700Schasinglulu 	} else {
53*91f16700Schasinglulu 		mt_cirq_flush();
54*91f16700Schasinglulu 		mt_cirq_disable();
55*91f16700Schasinglulu 	}
56*91f16700Schasinglulu 
57*91f16700Schasinglulu 	return ret;
58*91f16700Schasinglulu }
59*91f16700Schasinglulu 
60*91f16700Schasinglulu void mt_lp_irqremain_init(void)
61*91f16700Schasinglulu {
62*91f16700Schasinglulu 	uint32_t idx;
63*91f16700Schasinglulu 
64*91f16700Schasinglulu 	remain_irqs.count = 0U;
65*91f16700Schasinglulu 
66*91f16700Schasinglulu 	/*edge keypad*/
67*91f16700Schasinglulu 	idx = remain_irqs.count;
68*91f16700Schasinglulu 	remain_irqs.irqs[idx] = KEYPAD_IRQ_ID;
69*91f16700Schasinglulu 	remain_irqs.wakeupsrc_cat[idx] = 0U;
70*91f16700Schasinglulu 	remain_irqs.wakeupsrc[idx] = KEYPAD_WAKESRC;
71*91f16700Schasinglulu 	remain_irqs.count++;
72*91f16700Schasinglulu 
73*91f16700Schasinglulu 	mt_lp_irqremain_submit();
74*91f16700Schasinglulu }
75