A-Team_Digital_Solutions/android_kernel_motorola_sm6375
Watch
2
0
Fork
You've already forked android_kernel_motorola_sm6375
 0
mirror of https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git synced 2026-10-07 20:33:58 -04:00
Code Issues Projects Releases Packages Wiki Activity

Merge "input: qcom-hv-haptics: reset haptics module if it's stuck in SWR mode"

Browse source
This commit is contained in:
qctecmdr 2021-04-06 23:25:24 -07:00 • committed by Gerrit - the friendly Code Review server
commit 2aacece9d2
1 changed files with 30 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

30
drivers/input/misc/qcom-hv-haptics.c
View file

@ -79,7 +79,9 @@
#define DRV_WF_SEL_MASK GENMASK(1, 0)
#define HAP_CFG_AUTO_SHUTDOWN_CFG_REG 0x4A
#define HAP_CFG_TRIG_PRIORITY_REG 0x4B
#define SWR_IGNORE_BIT BIT(4)
#define HAP_CFG_SPMI_PLAY_REG 0x4C
#define PLAY_EN_BIT BIT(7)
@ -3902,6 +3904,34 @@ static int swr_slave_reg_enable(struct regulator_dev *rdev)
return rc;
}
/*
* If haptics has already been in SWR mode when enabling the SWR
* slave, it means that the haptics module was stuck in prevous
* SWR play. Then toggle HAPTICS_EN to reset haptics module and
* ignore SWR mode until next SWR slave enable request is coming.
*/
if (is_swr_play_enabled(chip)) {
rc = haptics_masked_write(chip, chip->cfg_addr_base,
HAP_CFG_TRIG_PRIORITY_REG,
SWR_IGNORE_BIT, SWR_IGNORE_BIT);
if (rc < 0) {
dev_err(chip->dev, "Failed to enable SWR_IGNORE, rc=%d\n", rc);
return rc;
}
rc = haptics_toggle_module_enable(chip);
if (rc < 0)
return rc;
} else {
rc = haptics_masked_write(chip, chip->cfg_addr_base,
HAP_CFG_TRIG_PRIORITY_REG,
SWR_IGNORE_BIT, 0);
if (rc < 0) {
dev_err(chip->dev, "Failed to disable SWR_IGNORE, rc=%d\n", rc);
return rc;
}
}
chip->swr_slave_enabled = true;
return 0;
}