From b1ba34da62f90fa409bfb01332ed37d7dc1805c1 Mon Sep 17 00:00:00 2001 From: tinno61 Date: Thu, 4 May 2023 17:48:48 +0800 Subject: [PATCH] bangkok add tp charger mode bangkok:add focal tp charger mode Change-Id: Idc0a8235fef180fdc681c5b025cc005829567a47 Reviewed-on: https://gerrit.mot.com/2596224 SME-Granted: SME Approvals Granted SLTApproved: Slta Waiver Tested-by: Jira Key Reviewed-by: Wei Deng Reviewed-by: Reviewed-by: Xiangpo Zhao Submit-Approved: Jira Key --- .../focaltech_touch_v3/focaltech_ts_mmi.c | 30 +++++++++++++------ 1 file changed, 21 insertions(+), 9 deletions(-) diff --git a/drivers/input/touchscreen/focaltech_touch_v3/focaltech_ts_mmi.c b/drivers/input/touchscreen/focaltech_touch_v3/focaltech_ts_mmi.c index 0cbdfa8e5b5e..d904d4c4317c 100644 --- a/drivers/input/touchscreen/focaltech_touch_v3/focaltech_ts_mmi.c +++ b/drivers/input/touchscreen/focaltech_touch_v3/focaltech_ts_mmi.c @@ -229,16 +229,28 @@ static int fts_mmi_charger_mode(struct device *dev, int mode) return -EINVAL; } - read_data |= (!!mode); - ret = fts_write_reg(FTS_REG_CHARGER_MODE_EN, read_data); - if(ret < 0){ - FTS_ERROR("Failed to set charger mode\n"); - mutex_unlock(&ts_data->mode_lock); - return -EINVAL; - } + if (ts_data->pdata->pocket_mode_ctrl) { + read_data |= (!!mode); + ret = fts_write_reg(FTS_REG_CHARGER_MODE_EN, read_data); + if(ret < 0){ + FTS_ERROR("Failed to set charger mode\n"); + mutex_unlock(&ts_data->mode_lock); + return -EINVAL; + } - FTS_INFO("Success to %s charger mode, 0x8B = 0x%02x\n", mode ? "Enable" : "Disable", - read_data); + FTS_INFO("Success to %s charger mode, 0x8B = 0x%02x\n", mode ? "Enable" : "Disable", + read_data); + } else { + ret = fts_write_reg(FTS_REG_CHARGER_MODE_EN, mode); + if(ret < 0){ + FTS_ERROR("Failed to set charger mode\n"); + mutex_unlock(&ts_data->mode_lock); + return -EINVAL; + } + + FTS_INFO("Success to %s charger mode, 0x8B = 0x%02x\n", mode ? "Enable" : "Disable", + mode); + } mutex_unlock(&ts_data->mode_lock); return 0;