64 lines
1.4 KiB
C
Executable File
64 lines
1.4 KiB
C
Executable File
/* SPDX-License-Identifier: GPL-2.0 */
|
|
/*
|
|
* Copyright (c) 2019 MediaTek Inc.
|
|
*/
|
|
|
|
#include <include/pmic_ipi.h>
|
|
#include <include/pmic_ipi_service_id.h>
|
|
#include <linux/kernel.h>
|
|
#include <mach/mtk_pmic_ipi.h>
|
|
#include <sspm_define.h>
|
|
#include <sspm_ipi_id.h>
|
|
|
|
#define PMIC_IPI_TIMEOUT 2000
|
|
|
|
static bool is_ipi_register;
|
|
static int sspm_pmic_ack;
|
|
|
|
static int pmic_ipi_to_sspm(struct pmic_ipi_cmds *ipi_cmd)
|
|
{
|
|
int ret, cmd_len;
|
|
|
|
if (!is_ipi_register) {
|
|
ret = mtk_ipi_register(&sspm_ipidev, IPIS_C_PMIC, NULL, NULL,
|
|
(void *)&sspm_pmic_ack);
|
|
if (ret) {
|
|
pr_notice("[PMIC] ipi_register fail, ret=%d\n", ret);
|
|
return ret;
|
|
}
|
|
is_ipi_register = true;
|
|
}
|
|
|
|
cmd_len = sizeof(struct pmic_ipi_cmds) / SSPM_MBOX_SLOT_SIZE;
|
|
ret = mtk_ipi_send_compl(&sspm_ipidev, IPIS_C_PMIC, IPI_SEND_POLLING,
|
|
ipi_cmd, cmd_len, PMIC_IPI_TIMEOUT);
|
|
if (ret) {
|
|
pr_notice("[PMIC] IPI fail ret=%d\n", ret);
|
|
return ret;
|
|
}
|
|
if (sspm_pmic_ack) {
|
|
pr_notice("[PMIC] IPI fail, ackdata=%d\n", sspm_pmic_ack);
|
|
return sspm_pmic_ack;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
unsigned int pmic_ipi_config_interface(unsigned int RegNum, unsigned int val,
|
|
unsigned int MASK, unsigned int SHIFT,
|
|
unsigned char _unused)
|
|
{
|
|
struct pmic_ipi_cmds ipi_cmd;
|
|
int ret;
|
|
|
|
ipi_cmd.cmd[0] = MAIN_PMIC_WRITE_REGISTER;
|
|
ipi_cmd.cmd[1] = RegNum;
|
|
ipi_cmd.cmd[2] = val;
|
|
ipi_cmd.cmd[3] = MASK;
|
|
ipi_cmd.cmd[4] = SHIFT;
|
|
|
|
ret = pmic_ipi_to_sspm(&ipi_cmd);
|
|
|
|
return abs(ret);
|
|
}
|
|
|