121 lines
2.5 KiB
C
121 lines
2.5 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright (c) 2019 MediaTek Inc.
|
|
*/
|
|
|
|
#include <linux/kthread.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_address.h>
|
|
|
|
#include <linux/scmi_protocol.h>
|
|
#include <linux/module.h>
|
|
#include <tinysys-scmi.h>
|
|
|
|
#include "mtk_cm_ipi.h"
|
|
|
|
//static phys_addr_t mem_phys_addr, mem_virt_addr;
|
|
//static unsigned long long mem_size;
|
|
static int cm_sspm_ready;
|
|
static int cm_ipi_enable = 1;
|
|
static int scmi_cm_id;
|
|
static struct scmi_tinysys_info_st *_tinfo;
|
|
|
|
|
|
|
|
|
|
int cm_get_ipi_enable(void)
|
|
{
|
|
return cm_ipi_enable;
|
|
}
|
|
EXPORT_SYMBOL(cm_get_ipi_enable);
|
|
|
|
void cm_set_ipi_enable(int enable)
|
|
{
|
|
cm_ipi_enable = enable;
|
|
}
|
|
EXPORT_SYMBOL(cm_set_ipi_enable);
|
|
|
|
void cm_sspm_enable(enable)
|
|
{
|
|
cm_mgr_to_sspm_command(IPI_CM_MGR_ENABLE, enable);
|
|
}
|
|
EXPORT_SYMBOL(cm_sspm_enable);
|
|
|
|
|
|
unsigned int cm_mgr_to_sspm_command(unsigned int cmd, unsigned int val)
|
|
{
|
|
struct cm_ipi_data cm_ipi_d;
|
|
struct scmi_tinysys_status rvalue;
|
|
unsigned int ret = 0;
|
|
unsigned int type, type_mask = 0xF0000000;
|
|
|
|
type = cmd & type_mask;
|
|
|
|
cm_ipi_d.cmd = cmd & ~type_mask;
|
|
cm_ipi_d.arg = val;
|
|
|
|
if (cm_sspm_ready != 1) {
|
|
pr_info("cm ipi not ready, skip cmd=%d\n", cm_ipi_d.cmd);
|
|
goto error;
|
|
}
|
|
|
|
pr_info("#@# %s(%d) cmd 0x%x, arg 0x%x\n", __func__, __LINE__,
|
|
cm_ipi_d.cmd, cm_ipi_d.arg);
|
|
|
|
switch (type) {
|
|
case IPI_CM_MGR_SCMI_SET:
|
|
ret = scmi_tinysys_common_set(_tinfo->ph, scmi_cm_id,
|
|
cm_ipi_d.cmd, cm_ipi_d.arg, 0, 0, 0);
|
|
if (ret) {
|
|
pr_info("cm ipi cmd %d send fail, ret = %d\n",
|
|
cm_ipi_d.cmd, ret);
|
|
goto error;
|
|
}
|
|
break;
|
|
case IPI_CM_MGR_SCMI_GET:
|
|
ret = scmi_tinysys_common_get(_tinfo->ph, scmi_cm_id,
|
|
cm_ipi_d.cmd, &rvalue);
|
|
if (ret) {
|
|
pr_info("cm ipi cmd %d send fail, ret = %d rvalue %d\n",
|
|
cm_ipi_d.cmd, ret, rvalue.r1);
|
|
goto error;
|
|
} else {
|
|
ret = rvalue.r1;
|
|
}
|
|
break;
|
|
default:
|
|
pr_info("#@# %s(%d) wrong cmd type(0x%x)!!!\n",
|
|
__func__, __LINE__, type);
|
|
break;
|
|
}
|
|
|
|
return ret;
|
|
error:
|
|
return -1;
|
|
}
|
|
EXPORT_SYMBOL(cm_mgr_to_sspm_command);
|
|
|
|
void cm_ipi_init(void)
|
|
{
|
|
unsigned int ret;
|
|
|
|
_tinfo = get_scmi_tinysys_info();
|
|
|
|
ret = of_property_read_u32(_tinfo->sdev->dev.of_node, "scmi-cm",
|
|
&scmi_cm_id);
|
|
if (ret) {
|
|
pr_info("get scmi-cm fail, ret %d\n", ret);
|
|
cm_sspm_ready = -2;
|
|
return;
|
|
}
|
|
pr_info("#@# %s(%d) scmi-cm_id %d\n", __func__, __LINE__, scmi_cm_id);
|
|
|
|
cm_sspm_ready = 1;
|
|
cm_sspm_enable(cm_ipi_enable);
|
|
pr_info("cm ipi is ready!\n");
|
|
}
|
|
EXPORT_SYMBOL(cm_ipi_init);
|
|
|
|
MODULE_DESCRIPTION("CM ipi Driver v0.1");
|
|
MODULE_LICENSE("GPL");
|