GK SDK 源码库: XMIPCLinuxV100R005C00SPC030 (kernel/tools/open_source excluded)
This commit is contained in:
+21
@@ -0,0 +1,21 @@
|
||||
/*
|
||||
* Copyright (c) 2020, MediaTek Inc. All rights reserved.
|
||||
*
|
||||
* SPDX-License-Identifier: BSD-3-Clause
|
||||
*/
|
||||
|
||||
#ifndef MT_SPM_SSPM_NOTIFIER_H
|
||||
#define MT_SPM_SSPM_NOTIFIER_H
|
||||
|
||||
enum MT_SPM_SSPM_NOTIFY_ID {
|
||||
MT_SPM_NOTIFY_LP_ENTER,
|
||||
MT_SPM_NOTIFY_LP_LEAVE,
|
||||
};
|
||||
|
||||
int mt_spm_sspm_notify(int type, unsigned int lp_mode);
|
||||
|
||||
static inline int mt_spm_sspm_notify_u32(int type, unsigned int lp_mode)
|
||||
{
|
||||
return mt_spm_sspm_notify(type, lp_mode);
|
||||
}
|
||||
#endif /* MT_SPM_SSPM_NOTIFIER_H */
|
||||
+33
@@ -0,0 +1,33 @@
|
||||
/*
|
||||
* Copyright (c) 2020, MediaTek Inc. All rights reserved.
|
||||
*
|
||||
* SPDX-License-Identifier: BSD-3-Clause
|
||||
*/
|
||||
|
||||
#ifndef MT_SPM_SSPM_INTC_H
|
||||
#define MT_SPM_SSPM_INTC_H
|
||||
|
||||
#include <mt_spm_reg.h>
|
||||
|
||||
#define MT_SPM_SSPM_INTC_SEL_0 0x10
|
||||
#define MT_SPM_SSPM_INTC_SEL_1 0x20
|
||||
#define MT_SPM_SSPM_INTC_SEL_2 0x40
|
||||
#define MT_SPM_SSPM_INTC_SEL_3 0x80
|
||||
|
||||
#define MT_SPM_SSPM_INTC_TRIGGER(id, sg) \
|
||||
(((0x10 << id) | (sg << id)) & 0xff)
|
||||
|
||||
#define MT_SPM_SSPM_INTC0_HIGH MT_SPM_SSPM_INTC_TRIGGER(0, 1)
|
||||
#define MT_SPM_SSPM_INTC0_LOW MT_SPM_SSPM_INTC_TRIGGER(0, 0)
|
||||
#define MT_SPM_SSPM_INTC1_HIGH MT_SPM_SSPM_INTC_TRIGGER(1, 1)
|
||||
#define MT_SPM_SSPM_INTC1_LOW MT_SPM_SSPM_INTC_TRIGGER(1, 0)
|
||||
#define MT_SPM_SSPM_INTC2_HIGH MT_SPM_SSPM_INTC_TRIGGER(2, 1)
|
||||
#define MT_SPM_SSPM_INTC2_LOW MT_SPM_SSPM_INTC_TRIGGER(2, 0)
|
||||
#define MT_SPM_SSPM_INTC3_HIGH MT_SPM_SSPM_INTC_TRIGGER(3, 1)
|
||||
#define MT_SPM_SSPM_INTC3_LOW MT_SPM_SSPM_INTC_TRIGGER(3, 0)
|
||||
|
||||
#define DO_SPM_SSPM_LP_SUSPEND() \
|
||||
mmio_write_32(SPM_MD32_IRQ, MT_SPM_SSPM_INTC0_HIGH)
|
||||
#define DO_SPM_SSPM_LP_RESUME() \
|
||||
mmio_write_32(SPM_MD32_IRQ, MT_SPM_SSPM_INTC0_LOW)
|
||||
#endif /* MT_SPM_SSPM_INTC_H */
|
||||
+47
@@ -0,0 +1,47 @@
|
||||
/*
|
||||
* Copyright (c) 2020, MediaTek Inc. All rights reserved.
|
||||
*
|
||||
* SPDX-License-Identifier: BSD-3-Clause
|
||||
*/
|
||||
|
||||
#include <stddef.h>
|
||||
|
||||
#include <lib/mmio.h>
|
||||
|
||||
#include <mt_spm_notifier.h>
|
||||
#include <mt_spm_sspm_intc.h>
|
||||
|
||||
#define MT_SPM_SSPM_MBOX_OFF(x) (SSPM_MBOX_BASE + x)
|
||||
#define MT_SPM_MBOX(slot) MT_SPM_SSPM_MBOX_OFF((slot << 2UL))
|
||||
|
||||
#define SSPM_MBOX_SPM_LP_LOOKUP1 MT_SPM_MBOX(0)
|
||||
#define SSPM_MBOX_SPM_LP_LOOKUP2 MT_SPM_MBOX(1)
|
||||
#define SSPM_MBOX_SPM_LP1 MT_SPM_MBOX(2)
|
||||
#define SSPM_MBOX_SPM_LP2 MT_SPM_MBOX(3)
|
||||
|
||||
#define MCUPM_MBOX_OFFSET_LP 0x0C55FDA4
|
||||
#define MCUPM_MBOX_ENTER_LP 0x454e0000
|
||||
#define MCUPM_MBOX_LEAVE_LP 0x4c450000
|
||||
#define MCUPM_MBOX_SLEEP_MASK 0x0000FFFF
|
||||
|
||||
int mt_spm_sspm_notify(int type, unsigned int lp_mode)
|
||||
{
|
||||
switch (type) {
|
||||
case MT_SPM_NOTIFY_LP_ENTER:
|
||||
mmio_write_32(SSPM_MBOX_SPM_LP1, lp_mode);
|
||||
mmio_write_32(MCUPM_MBOX_OFFSET_LP, MCUPM_MBOX_ENTER_LP |
|
||||
(lp_mode & MCUPM_MBOX_SLEEP_MASK));
|
||||
DO_SPM_SSPM_LP_SUSPEND();
|
||||
break;
|
||||
case MT_SPM_NOTIFY_LP_LEAVE:
|
||||
mmio_write_32(SSPM_MBOX_SPM_LP1, lp_mode);
|
||||
mmio_write_32(MCUPM_MBOX_OFFSET_LP, MCUPM_MBOX_LEAVE_LP |
|
||||
(lp_mode & MCUPM_MBOX_SLEEP_MASK));
|
||||
DO_SPM_SSPM_LP_RESUME();
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user