threeeye
bc1d038eac
Squashed backup commit (no shallow-clone history issues) of xiaomi-mt6833-dev/kernel_xiaomi_mt6833 (lineage-23.2 branch, upstream commit 9eece662e) plus all fixes applied to get everpal_defconfig building clean against a modern (GCC 15.2.0) toolchain -- see the previous commit message on the lineage-23.2 branch (also in this repo history is not available here since this is a squashed snapshot; full incremental history lives in the local DL380 checkout and the upstream GitHub remote). Upstream: https://github.com/xiaomi-mt6833-dev/kernel_xiaomi_mt6833 (lineage-23.2)
72 lines
1.8 KiB
C
72 lines
1.8 KiB
C
/*
|
|
* Copyright (C) 2019 MediaTek Inc.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
|
* See http://www.gnu.org/licenses/gpl-2.0.html for more details.
|
|
*/
|
|
|
|
#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);
|
|
}
|
|
|