Commit 5575802d authored by Hans de Goede's avatar Hans de Goede Committed by Sebastian Reichel
Browse files

power: supply: bq25890: Add bq25890_set_otg_cfg() helper 



Add a bq25890_set_otg_cfg() helper function, this is a preparation
patch for adding regulator support.

Reviewed-by: default avatarAndy Shevchenko <andriy.shevchenko@linux.intel.com>
Signed-off-by: default avatarHans de Goede <hdegoede@redhat.com>
Signed-off-by: default avatarSebastian Reichel <sebastian.reichel@collabora.com>
parent f481d5b8

drivers/power/supply/bq25890_charger.c

+15 −13
Original line number Diff line number Diff line
@@ -832,6 +832,17 @@ static int bq25890_power_supply_init(struct bq25890_device *bq) 
	return PTR_ERR_OR_ZERO(bq->charger);

}



static int bq25890_set_otg_cfg(struct bq25890_device *bq, u8 val)

{

	int ret;



	ret = bq25890_field_write(bq, F_OTG_CFG, val);

	if (ret < 0)

		dev_err(bq->dev, "Error switching to boost/charger mode: %d\n", ret);



	return ret;

}



static void bq25890_usb_work(struct work_struct *data)

{

	int ret;
@@ -841,25 +852,16 @@ static void bq25890_usb_work(struct work_struct *data) 
	switch (bq->usb_event) {

	case USB_EVENT_ID:

		/* Enable boost mode */

		ret = bq25890_field_write(bq, F_OTG_CFG, 1);

		if (ret < 0)

			goto error;

		bq25890_set_otg_cfg(bq, 1);

		break;



	case USB_EVENT_NONE:

		/* Disable boost mode */

		ret = bq25890_field_write(bq, F_OTG_CFG, 0);

		if (ret < 0)

			goto error;



		ret = bq25890_set_otg_cfg(bq, 0);

		if (ret == 0)

			power_supply_changed(bq->charger);

		break;

	}



	return;



error:

	dev_err(bq->dev, "Error switching to boost/charger mode.\n");

}



static int bq25890_usb_notifier(struct notifier_block *nb, unsigned long val,