samsung-sm8650/android_kernel_samsung_sm8650-modules
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

asoc: swr-haptics: Handle VMAX_CLAMP notification

Browse Source 
Handle VMAX_CLAMP notification which is notified from charger driver
that hBoost is used by the charger firmware and haptics Vmax need to
be clamped to a specific level for the following vibrations.

Change-Id: I3d783467aad71e0d9b31a96120db7e89fd54c5cb
Signed-off-by: Fenglin Wu <quic_fenglinw@quicinc.com>
This commit is contained in:
Fenglin Wu
2022-01-18 12:44:09 +08:00
parent be2f9dada8
commit 174bcf30d4
1 changed files with 39 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

40
asoc/codecs/swr-haptics.c
View File

@@ -15,6 +15,7 @@
#include <soc/soundwire.h>
#include <sound/soc.h>
#include <sound/soc-dapm.h>
#include <linux/soc/qcom/battery_charger.h>
#define HAPTICS_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000 |\
SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_48000 |\
@@ -89,11 +90,13 @@ struct swr_haptics_dev {
struct swr_port port;
struct regulator *slave_vdd;
struct regulator *hpwr_vreg;
struct notifier_block hboost_nb;
u32 hpwr_voltage_mv;
bool slave_enabled;
bool hpwr_vreg_enabled;
bool ssr_recovery;
u8 vmax;
u8 clamped_vmax;
u8 flags;
};
@@ -254,6 +257,7 @@ static int hap_enable_swr_dac_port(struct snd_soc_dapm_widget *w,
snd_soc_dapm_to_component(w->dapm);
struct swr_haptics_dev *swr_hap;
u8 port_id, ch_mask, num_ch, port_type, num_port;
u8 vmax;
u32 ch_rate;
unsigned int val;
int rc;
@@ -287,7 +291,11 @@ static int hap_enable_swr_dac_port(struct snd_soc_dapm_widget *w,
swr_hap->ssr_recovery = false;
}
rc = regmap_write(swr_hap->regmap, SWR_VMAX_REG, swr_hap->vmax);
vmax = swr_hap->vmax;
if ((swr_hap->clamped_vmax != 0) && (swr_hap->vmax > swr_hap->clamped_vmax))
vmax = swr_hap->clamped_vmax;
rc = regmap_write(swr_hap->regmap, SWR_VMAX_REG, vmax);
if (rc) {
dev_err_ratelimited(swr_hap->dev, "%s: SWR_VMAX update failed, rc=%d\n",
__func__, rc);
@@ -488,6 +496,33 @@ static int swr_haptics_parse_port_mapping(struct swr_device *sdev)
return 0;
}
#define MAX_HAPTICS_VMAX_MV 10000
#define VMAX_STEP_MV 50
static int hboost_notifier(struct notifier_block *nb, unsigned long event, void *val)
{
struct swr_haptics_dev *swr_hap = container_of(nb, struct swr_haptics_dev, hboost_nb);
u32 vmax_mv;
switch (event) {
case VMAX_CLAMP:
vmax_mv = *(u32 *)val;
if (vmax_mv > MAX_HAPTICS_VMAX_MV) {
dev_err_ratelimited(swr_hap->dev, "%s: voted Vmax (%u mv) is higher than maximum (%u mv)\n",
__func__, vmax_mv, MAX_HAPTICS_VMAX_MV);
return -EINVAL;
}
dev_dbg(swr_hap->dev, "%s: Vmax is clamped at %u mv to support hBoost concurrency\n",
__func__, vmax_mv);
swr_hap->clamped_vmax = vmax_mv / VMAX_STEP_MV;
break;
default:
break;
}
return 0;
}
static int swr_haptics_probe(struct swr_device *sdev)
{
struct swr_haptics_dev *swr_hap;
@@ -584,6 +619,8 @@ static int swr_haptics_probe(struct swr_device *sdev)
goto dev_err;
}
swr_hap->hboost_nb.notifier_call = hboost_notifier;
register_hboost_event_notifier(&swr_hap->hboost_nb);
return 0;
dev_err:
swr_haptics_slave_disable(swr_hap);
@@ -605,6 +642,7 @@ static int swr_haptics_remove(struct swr_device *sdev)
goto clean;
}
unregister_hboost_event_notifier(&swr_hap->hboost_nb);
rc = swr_haptics_slave_disable(swr_hap);
if (rc < 0) {
dev_err(swr_hap->dev, "%s: disable swr-slave failed, rc=%d\n",