Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 57da5e86 authored by Sebastian Reichel's avatar Sebastian Reichel
Browse files

rx51_battery: convert to iio consumer 



Update rx51-battery driver to use the new IIO API of
twl4030-madc and add DT support.

Signed-off-by: default avatarSebastian Reichel <sre@kernel.org>
parent 3c018504

drivers/power/rx51_battery.c

+66 −24
Original line number Diff line number Diff line
@@ -24,34 +24,27 @@ 
#include <linux/power_supply.h>

#include <linux/slab.h>

#include <linux/i2c/twl4030-madc.h>



/* RX51 specific channels */

#define TWL4030_MADC_BTEMP_RX51	TWL4030_MADC_ADCIN0

#define TWL4030_MADC_BCI_RX51	TWL4030_MADC_ADCIN4

#include <linux/iio/consumer.h>

#include <linux/of.h>



struct rx51_device_info {

	struct device *dev;

	struct power_supply bat;

	struct iio_channel *channel_temp;

	struct iio_channel *channel_bsi;

	struct iio_channel *channel_vbat;

};



/*

 * Read ADCIN channel value, code copied from maemo kernel

 */

static int rx51_battery_read_adc(int channel)

static int rx51_battery_read_adc(struct iio_channel *channel)

{

	struct twl4030_madc_request req;



	req.channels = channel;

	req.do_avg = 1;

	req.method = TWL4030_MADC_SW1;

	req.func_cb = NULL;

	req.type = TWL4030_MADC_WAIT;

	req.raw = true;



	if (twl4030_madc_conversion(&req) <= 0)

		return -ENODATA;



	return req.rbuf[ffs(channel) - 1];

	int val, err;

	err = iio_read_channel_average_raw(channel, &val);

	if (err < 0)

		return err;

	return val;

}



/*
@@ -60,10 +53,12 @@ static int rx51_battery_read_adc(int channel) 
 */

static int rx51_battery_read_voltage(struct rx51_device_info *di)

{

	int voltage = rx51_battery_read_adc(TWL4030_MADC_VBAT);

	int voltage = rx51_battery_read_adc(di->channel_vbat);



	if (voltage < 0)

	if (voltage < 0) {

		dev_err(di->dev, "Could not read ADC: %d\n", voltage);

		return voltage;

	}



	return 1000 * (10000 * voltage / 1705);

}
@@ -112,7 +107,10 @@ static int rx51_battery_read_temperature(struct rx51_device_info *di) 
{

	int min = 0;

	int max = ARRAY_SIZE(rx51_temp_table2) - 1;

	int raw = rx51_battery_read_adc(TWL4030_MADC_BTEMP_RX51);

	int raw = rx51_battery_read_adc(di->channel_temp);



	if (raw < 0)

		dev_err(di->dev, "Could not read ADC: %d\n", raw);



	/* Zero and negative values are undefined */

	if (raw <= 0)
@@ -146,10 +144,12 @@ static int rx51_battery_read_temperature(struct rx51_device_info *di) 
 */

static int rx51_battery_read_capacity(struct rx51_device_info *di)

{

	int capacity = rx51_battery_read_adc(TWL4030_MADC_BCI_RX51);

	int capacity = rx51_battery_read_adc(di->channel_bsi);



	if (capacity < 0)

	if (capacity < 0) {

		dev_err(di->dev, "Could not read ADC: %d\n", capacity);

		return capacity;

	}



	return 1280 * (1200 * capacity)/(1024 - capacity);

}
@@ -213,17 +213,46 @@ static int rx51_battery_probe(struct platform_device *pdev) 


	platform_set_drvdata(pdev, di);



	di->dev = &pdev->dev;

	di->bat.name = dev_name(&pdev->dev);

	di->bat.type = POWER_SUPPLY_TYPE_BATTERY;

	di->bat.properties = rx51_battery_props;

	di->bat.num_properties = ARRAY_SIZE(rx51_battery_props);

	di->bat.get_property = rx51_battery_get_property;



	di->channel_temp = iio_channel_get(di->dev, "temp");

	if (IS_ERR(di->channel_temp)) {

		ret = PTR_ERR(di->channel_temp);

		goto error;

	}



	di->channel_bsi  = iio_channel_get(di->dev, "bsi");

	if (IS_ERR(di->channel_bsi)) {

		ret = PTR_ERR(di->channel_bsi);

		goto error_channel_temp;

	}



	di->channel_vbat = iio_channel_get(di->dev, "vbat");

	if (IS_ERR(di->channel_vbat)) {

		ret = PTR_ERR(di->channel_vbat);

		goto error_channel_bsi;

	}



	ret = power_supply_register(di->dev, &di->bat);

	if (ret)

		return ret;

		goto error_channel_vbat;



	return 0;



error_channel_vbat:

	iio_channel_release(di->channel_vbat);

error_channel_bsi:

	iio_channel_release(di->channel_bsi);

error_channel_temp:

	iio_channel_release(di->channel_temp);

error:



	return ret;

}



static int rx51_battery_remove(struct platform_device *pdev)
@@ -232,15 +261,28 @@ static int rx51_battery_remove(struct platform_device *pdev) 


	power_supply_unregister(&di->bat);



	iio_channel_release(di->channel_vbat);

	iio_channel_release(di->channel_bsi);

	iio_channel_release(di->channel_temp);



	return 0;

}



#ifdef CONFIG_OF

static const struct of_device_id n900_battery_of_match[] = {

	{.compatible = "nokia,n900-battery", },

	{ },

};

MODULE_DEVICE_TABLE(of, n900_battery_of_match);

#endif



static struct platform_driver rx51_battery_driver = {

	.probe = rx51_battery_probe,

	.remove = rx51_battery_remove,

	.driver = {

		.name = "rx51-battery",

		.owner = THIS_MODULE,

		.of_match_table = of_match_ptr(n900_battery_of_match),

	},

};

module_platform_driver(rx51_battery_driver);