static void bcl_periph_ibat_notify(enum bcl_trip_type type, int trip_temp,
void *data)
{
if (type == BCL_HIGH_TRIP)
bcl_ibat_notify(BCL_HIGH_THRESHOLD);
else
bcl_ibat_notify(BCL_LOW_THRESHOLD);
return;
}
static void bcl_periph_mode_set(enum bcl_device_mode mode)
{
int ret = 0;
if (mode == BCL_DEVICE_ENABLED) {
power_supply_callback(&bcl_psy);
ret = power_supply_register(gbcl->dev, &bcl_psy);
if (ret < 0) {
pr_err("Unable to register bcl_psy rc = %d\n", ret);
return;
}
ret = msm_bcl_set_threshold(BCL_PARAM_CURRENT, BCL_HIGH_TRIP,
&gbcl->ibat_high_thresh);
if (ret) {
pr_err("Error setting Ibat high threshold. err:%d\n",
ret);
return;
}
ret = msm_bcl_set_threshold(BCL_PARAM_CURRENT, BCL_LOW_TRIP,
&gbcl->ibat_low_thresh);
if (ret) {
pr_err("Error setting Ibat low threshold. err:%d\n",
ret);
return;
}
ret = msm_bcl_set_threshold(BCL_PARAM_VOLTAGE, BCL_LOW_TRIP,
&gbcl->vbat_low_thresh);
if (ret) {
pr_err("Error setting Vbat low threshold. err:%d\n",
ret);
return;
}
ret = msm_bcl_set_threshold(BCL_PARAM_VOLTAGE, BCL_HIGH_TRIP,
&gbcl->vbat_high_thresh);
if (ret) {
pr_err("Error setting Vbat high threshold. err:%d\n",
ret);
return;
}
ret = msm_bcl_enable();
if (ret) {
pr_err("Error enabling BCL\n");
return;
}
gbcl->btm_mode = BCL_VPH_MONITOR_MODE;
} else {
power_supply_unregister(&bcl_psy);
ret = msm_bcl_disable();
if (ret) {
pr_err("Error disabling BCL\n");
return;
}
gbcl->btm_mode = BCL_MONITOR_DISABLED;
bcl_soc_state = BCL_THRESHOLD_DISABLED;
bcl_vph_notify(BCL_HIGH_THRESHOLD);
bcl_ibat_notify(BCL_LOW_THRESHOLD);
bcl_handle_hotplug(NULL);
}
}
static void bcl_ibat_notification(enum qpnp_tm_state state, void *ctx)
{
struct bcl_context *bcl = ctx;
int ret = 0;
mutex_lock(&bcl_notify_mutex);
if (bcl->btm_mode == BCL_MONITOR_DISABLED ||
bcl->btm_mode == BCL_VPH_MONITOR_MODE)
goto unlock_and_return;
switch (state) {
case ADC_TM_LOW_STATE:
if (bcl->btm_mode != BCL_IBAT_HIGH_LOAD_MODE)
goto set_ibat_threshold;
pr_debug("ibat low load enter\n");
bcl->btm_mode = BCL_IBAT_MONITOR_MODE;
bcl_ibat_notify(BCL_LOW_THRESHOLD);
break;
case ADC_TM_HIGH_STATE:
if (bcl->btm_mode != BCL_IBAT_MONITOR_MODE)
goto set_ibat_threshold;
pr_debug("ibat high load enter\n");
bcl->btm_mode = BCL_IBAT_HIGH_LOAD_MODE;
bcl_ibat_notify(BCL_HIGH_THRESHOLD);
break;
default:
pr_err("Invalid threshold state:%d\n", state);
bcl_config_ibat_adc(bcl, BCL_HIGH_THRESHOLD_TYPE);
goto unlock_and_return;
}
set_ibat_threshold:
ret = bcl_config_ibat_adc(bcl, (state == ADC_TM_LOW_STATE) ?
BCL_HIGH_THRESHOLD_TYPE : BCL_LOW_THRESHOLD_TYPE);
if (ret < 0)
pr_err("Error configuring %s thresh. err:%d\n",
(state == ADC_TM_LOW_STATE) ? "high" : "low", ret);
unlock_and_return:
mutex_unlock(&bcl_notify_mutex);
}
static int ibat_disable(void)
{
int ret = 0;
ret = qpnp_adc_tm_disable_chan_meas(gbcl->btm_adc_tm_dev,
&gbcl->btm_ibat_adc_param);
if (ret) {
pr_err("Error disabling ADC. err:%d\n", ret);
gbcl->bcl_mode = BCL_DEVICE_ENABLED;
gbcl->btm_mode = BCL_IBAT_MONITOR_MODE;
goto ibat_disable_exit;
}
bcl_ibat_notify(BCL_THRESHOLD_DISABLED);
ibat_disable_exit:
return ret;
}
int bcl_current_notify(bool is_high_thresh)
{
int ret = 0;
if (!gbcl) {
pr_err("BCL Driver not configured\n");
return -EINVAL;
}
if (gbcl->bcl_mode == BCL_DEVICE_ENABLED) {
pr_err("BCL Driver is enabled\n");
return -EINVAL;
}
bcl_ibat_notify((is_high_thresh) ? BCL_HIGH_THRESHOLD
: BCL_LOW_THRESHOLD);
return ret;
}
