github-mirror/linux
1
0
Fork 0
mirror of https://github.com/torvalds/linux.git synced 2026-06-08 22:52:35 +02:00
Code Issues Actions Packages Projects Releases Wiki Activity Graph

RK3368 MCU: add MCU suspend and resume function

Browse Source 
Signed-off-by: Tang Yun ping <typ@rock-chips.com>
This commit is contained in:
Tang Yun ping 2015-05-11 14:54:22 +08:00
parent 65841919f8
commit ce118b8a83
5 changed files with 80 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
drivers/devfreq/ddr_rk3368.c
View File

@ -257,6 +257,12 @@ static void ddr_init(u32 dram_speed_bin, u32 freq)
printk(KERN_DEBUG pr_fmt("%s out\n"), __func__);
}
static int ddr_init_resume(struct platform_device *pdev)
{
ddr_init(DDR3_DEFAULT, 0);
return 0;
}
static int __init rockchip_ddr_probe(struct platform_device *pdev)
{
struct device_node *np;
@ -311,6 +317,9 @@ static const struct of_device_id rockchip_ddr_of_match[] __refdata = {
};
static struct platform_driver rockchip_ddr_driver = {
#ifdef CONFIG_PM
.resume = ddr_init_resume,
#endif /* CONFIG_PM */
.driver = {
.name = "rockchip_ddr",
.of_match_table = rockchip_ddr_of_match,

29
drivers/mailbox/rockchip_mailbox.c
View File

@ -23,6 +23,7 @@
#include <linux/clk.h>
#include <linux/rockchip-mailbox.h>
#include <linux/scpi_protocol.h>
#define MAILBOX_A2B_INTEN 0x00
#define MAILBOX_A2B_STATUS 0x04
@ -160,6 +161,30 @@ static struct of_device_id rockchip_mbox_of_match[] = {
};
MODULE_DEVICE_TABLE(of, rockchp_mbox_of_match);
#ifdef CONFIG_PM
static int rockchip_mbox_suspend(struct platform_device *pdev,
pm_message_t state)
{
struct rockchip_mbox *mb = platform_get_drvdata(pdev);
if (scpi_sys_set_mcu_state_suspend())
dev_err(mb->mbox.dev, "scpi_sys_set_mcu_state_suspend timeout.\n");
return 0;
}
static int rockchip_mbox_resume(struct platform_device *pdev)
{
struct rockchip_mbox *mb = platform_get_drvdata(pdev);
writel_relaxed((1 << mb->mbox.num_chans) - 1,
mb->mbox_base + MAILBOX_B2A_INTEN);
if (scpi_sys_set_mcu_state_resume())
dev_err(mb->mbox.dev, "scpi_sys_set_mcu_state_resume timeout.\n");
return 0;
}
#endif /* CONFIG_PM */
static int rockchip_mbox_probe(struct platform_device *pdev)
{
struct rockchip_mbox *mb;
@ -266,6 +291,10 @@ static int rockchip_mbox_remove(struct platform_device *pdev)
static struct platform_driver rockchip_mbox_driver = {
.probe = rockchip_mbox_probe,
.remove = rockchip_mbox_remove,
#ifdef CONFIG_PM
.suspend = rockchip_mbox_suspend,
.resume = rockchip_mbox_resume,
#endif /* CONFIG_PM */
.driver = {
.name = "rockchip-mailbox",
.of_match_table = of_match_ptr(rockchip_mbox_of_match),

2
drivers/mailbox/scpi_cmd.h
View File

@ -57,6 +57,8 @@ enum scpi_ddr_cmd {
enum scpi_sys_cmd {
SCPI_SYS_GET_VERSION,
SCPI_SYS_REFRESH_MCU_FREQ,
SCPI_SYS_SET_MCU_STATE_SUSPEND,
SCPI_SYS_SET_MCU_STATE_RESUME,
};
enum scpi_std_cmd {

37
drivers/mailbox/scpi_protocol.c
View File

@ -400,6 +400,43 @@ static int scpi_get_version(u32 old, u32 *ver)
return ret;
}
int scpi_sys_set_mcu_state_suspend(void)
{
struct scpi_data_buf sdata;
struct rockchip_mbox_msg mdata;
struct __packed1 {
u32 status;
} tx_buf;
struct __packed2 {
u32 status;
} rx_buf;
tx_buf.status = 0;
SCPI_SETUP_DBUF(sdata, mdata, SCPI_CL_SYS,
SCPI_SYS_SET_MCU_STATE_SUSPEND, tx_buf, rx_buf);
return scpi_execute_cmd(&sdata);
}
EXPORT_SYMBOL_GPL(scpi_sys_set_mcu_state_suspend);
int scpi_sys_set_mcu_state_resume(void)
{
struct scpi_data_buf sdata;
struct rockchip_mbox_msg mdata;
struct __packed1 {
u32 status;
} tx_buf;
struct __packed2 {
u32 status;
} rx_buf;
tx_buf.status = 0;
SCPI_SETUP_DBUF(sdata, mdata, SCPI_CL_SYS,
SCPI_SYS_SET_MCU_STATE_RESUME, tx_buf, rx_buf);
return scpi_execute_cmd(&sdata);
}
EXPORT_SYMBOL_GPL(scpi_sys_set_mcu_state_resume);
int scpi_ddr_init(u32 dram_speed_bin, u32 freq, u32 lcdc_type)
{
struct scpi_data_buf sdata;

3
include/linux/scpi_protocol.h
View File

@ -37,6 +37,9 @@ struct scpi_opp *scpi_dvfs_get_opps(u8 domain);
int scpi_get_sensor(char *name);
int scpi_get_sensor_value(u16 sensor, u32 *val);
int scpi_sys_set_mcu_state_suspend(void);
int scpi_sys_set_mcu_state_resume(void);
int scpi_ddr_init(u32 dram_speed_bin, u32 freq, u32 lcdc_type);
int scpi_ddr_set_clk_rate(u32 rate);
int scpi_ddr_round_rate(u32 m_hz);