84 lines
1.7 KiB
C
84 lines
1.7 KiB
C
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
|
/*
|
||
|
|
* Copyright (c) 2019 MediaTek Inc.
|
||
|
|
*/
|
||
|
|
#include <linux/module.h>
|
||
|
|
#include <linux/kernel.h>
|
||
|
|
#include <mtk_lp_plat_apmcu.h>
|
||
|
|
|
||
|
|
#include "mt6779.h"
|
||
|
|
#include "mt6779_ipi_sspm.h"
|
||
|
|
|
||
|
|
#include <idles/mt6779_mcusys.h>
|
||
|
|
#include <suspend/mt6779_suspend.h>
|
||
|
|
|
||
|
|
static unsigned int mt6779_lp_pwr_state;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Please make sure the race condition protection upfront
|
||
|
|
* when calling mtk_lp_plat_do_mcusys_prepare_pdn()
|
||
|
|
*/
|
||
|
|
int mt6779_do_mcusys_prepare_pdn(unsigned int status,
|
||
|
|
unsigned int *resource_req)
|
||
|
|
{
|
||
|
|
mt6779_sspm_notify_enter(status);
|
||
|
|
mt6779_lp_pwr_state |= (status | PLAT_GIC_MASKED
|
||
|
|
| PLAT_MCUSYSOFF_PREPARED);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Please make sure the race condition protection upfront
|
||
|
|
* when calling mtk_lp_plat_do_mcusys_prepare_on()
|
||
|
|
*/
|
||
|
|
static int __mt6779_do_mcusys_prepare_on(unsigned int clr_status)
|
||
|
|
{
|
||
|
|
mt6779_sspm_notify_leave(clr_status);
|
||
|
|
mt6779_lp_pwr_state &= ~(clr_status | PLAT_GIC_MASKED
|
||
|
|
| PLAT_MCUSYSOFF_PREPARED);
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int mt6779_do_mcusys_prepare_on(void)
|
||
|
|
{
|
||
|
|
unsigned int status = mt6779_lp_pwr_state;
|
||
|
|
|
||
|
|
return __mt6779_do_mcusys_prepare_on(status);
|
||
|
|
}
|
||
|
|
|
||
|
|
int mt6779_do_mcusys_prepare_on_ex(unsigned int clr_status)
|
||
|
|
{
|
||
|
|
return __mt6779_do_mcusys_prepare_on(clr_status);
|
||
|
|
}
|
||
|
|
|
||
|
|
static int mt6779_init(void)
|
||
|
|
{
|
||
|
|
mtk_lp_plat_apmcu_init();
|
||
|
|
mt6779_model_mcusys_init();
|
||
|
|
mt6779_model_suspend_init();
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int mt6779_early_init(void)
|
||
|
|
{
|
||
|
|
mtk_lp_plat_apmcu_early_init();
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
static int __init mtk_lpm_mt6779_init(void)
|
||
|
|
{
|
||
|
|
mt6779_early_init();
|
||
|
|
mt6779_init();
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
static void __exit mtk_lpm_mt6779_exit(void)
|
||
|
|
{
|
||
|
|
}
|
||
|
|
module_init(mtk_lpm_mt6779_init);
|
||
|
|
module_exit(mtk_lpm_mt6779_exit);
|
||
|
|
MODULE_LICENSE("GPL");
|
||
|
|
MODULE_DESCRIPTION("Mediatek LPM mt6779");
|
||
|
|
MODULE_AUTHOR("MediaTek Inc.");
|