From 55eb147a56cf8b438fa564b3ecd3cbadfcfcdafe Mon Sep 17 00:00:00 2001 From: Fenglin Wu Date: Thu, 4 Jun 2020 15:57:39 +0800 Subject: [PATCH] input: qcom-hv-haptics: restore RC calibration mode after FIFO playing Auto RC clock calibration is used as default configuration. When playing FIFO streaming data, manual RC clock calibration is used for adjusting the FIFO pattern based on the detected LRA frequency. Restore back to use auto RC clock calibration after FIFO pattern is played. Change-Id: I335552cfeafe559aa35a76bf6aa218a92b62d3db Signed-off-by: Fenglin Wu --- drivers/input/misc/qcom-hv-haptics.c | 13 +++++++++++++ 1 file changed, 13 insertions(+) diff --git a/drivers/input/misc/qcom-hv-haptics.c b/drivers/input/misc/qcom-hv-haptics.c index 6965030a02d9..d309b6cd7143 100644 --- a/drivers/input/misc/qcom-hv-haptics.c +++ b/drivers/input/misc/qcom-hv-haptics.c @@ -1687,6 +1687,7 @@ static void haptics_fifo_empty_irq_config(struct haptics_chip *chip, static int haptics_stop_fifo_play(struct haptics_chip *chip) { int rc; + u8 val; if (atomic_read(&chip->play.fifo_status.is_busy) == 0) { dev_dbg(chip->dev, "FIFO playing is not in progress\n"); @@ -1707,6 +1708,18 @@ static int haptics_stop_fifo_play(struct haptics_chip *chip) chip->custom_effect->fifo->samples = NULL; atomic_set(&chip->play.fifo_status.is_busy, 0); + + /* + * All other playing modes would use AUTO mode RC + * calibration except FIFO streaming mode, so restore + * back to AUTO RC calibration after FIFO playing. + */ + val = CAL_RC_CLK_AUTO_VAL << CAL_RC_CLK_SHIFT; + rc = haptics_masked_write(chip, chip->cfg_addr_base, + HAP_CFG_CAL_EN_REG, CAL_RC_CLK_MASK, val); + if (rc < 0) + return rc; + dev_dbg(chip->dev, "stopped FIFO playing successfully\n"); return 0; }