#include <linux/array_size.h>
#include <linux/bitfield.h>
#include <linux/bits.h>
#include <linux/cleanup.h>
#include <linux/delay.h>
#include <linux/iio/iio.h>
#include <linux/module.h>
#include <linux/mutex.h>
#include <linux/platform_device.h>
#include <linux/regmap.h>
#include <linux/stringify.h>
#include <linux/time.h>
#include <linux/types.h>
#include <linux/mfd/mt6323/registers.h>
#include <dt-bindings/iio/adc/mediatek,mt6323-auxadc.h>
#define AUXADC_STRUP_CON10_RSTB_SEL BIT(7)
#define AUXADC_STRUP_CON10_RSTB_SW BIT(5)
#define AUXADC_TOP_CKPDN2_CTL_CK BIT(5)
#define AUXADC_TRIM_CH2_MASK GENMASK(11, 10)
#define AUXADC_TRIM_CH4_MASK GENMASK(9, 8)
#define AUXADC_TRIM_CH5_MASK GENMASK(5, 4)
#define AUXADC_TRIM_CH6_MASK GENMASK(3, 2)
#define AUXADC_CON27_VREF18_ENB_MD BIT(15)
#define AUXADC_CON27_MD_STATUS BIT(0)
#define AUXADC_CON19_GPS_STATUS BIT(1)
#define AUXADC_CON26_VREF18_SELB BIT(1)
#define AUXADC_CON26_DECI_GDLY_SEL BIT(0)
#define AUXADC_CON11_VBUF_EN BIT(4)
#define AUXADC_CON19_DECI_GDLY_MASK GENMASK(15, 14)
#define AUXADC_ADC19_BUSY_MASK GENMASK(15, 1)
#define AUXADC_READY_MASK BIT(15)
#define AUXADC_DATA_MASK GENMASK(14, 0)
#define AUXADC_CON9_OSR_MASK GENMASK(12, 10)
#define AUXADC_DEFAULT_OSR 3
#define MTK_PMIC_IIO_CHAN(_name, _chan, _addr) \
{ \
.type = IIO_VOLTAGE, \
.indexed = 1, \
.channel = _chan, \
.address = _addr, \
.datasheet_name = __stringify(_name), \
.info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
BIT(IIO_CHAN_INFO_SCALE), \
}
static const struct iio_chan_spec mt6323_auxadc_channels[] = {
MTK_PMIC_IIO_CHAN(baton2, MT6323_AUXADC_BATON2, MT6323_AUXADC_ADC6),
MTK_PMIC_IIO_CHAN(ch6, MT6323_AUXADC_CH6, MT6323_AUXADC_ADC11),
MTK_PMIC_IIO_CHAN(bat_temp, MT6323_AUXADC_BAT_TEMP, MT6323_AUXADC_ADC5),
MTK_PMIC_IIO_CHAN(chip_temp, MT6323_AUXADC_CHIP_TEMP, MT6323_AUXADC_ADC4),
MTK_PMIC_IIO_CHAN(vcdt, MT6323_AUXADC_VCDT, MT6323_AUXADC_ADC2),
MTK_PMIC_IIO_CHAN(baton1, MT6323_AUXADC_BATON1, MT6323_AUXADC_ADC3),
MTK_PMIC_IIO_CHAN(isense, MT6323_AUXADC_ISENSE, MT6323_AUXADC_ADC1),
MTK_PMIC_IIO_CHAN(batsns, MT6323_AUXADC_BATSNS, MT6323_AUXADC_ADC0),
MTK_PMIC_IIO_CHAN(accdet, MT6323_AUXADC_ACCDET, MT6323_AUXADC_ADC7),
};
struct mt6323_auxadc {
struct regmap *regmap;
struct mutex lock;
};
static int mt6323_auxadc_prepare_channel(struct mt6323_auxadc *auxadc)
{
struct regmap *map = auxadc->regmap;
u32 val;
int ret;
ret = regmap_read(map, MT6323_AUXADC_CON19, &val);
if (ret)
return ret;
if (!(val & AUXADC_CON19_DECI_GDLY_MASK))
return 0;
ret = regmap_read_poll_timeout(map, MT6323_AUXADC_ADC19,
val, !(val & AUXADC_ADC19_BUSY_MASK),
10, 500);
if (ret)
return ret;
return regmap_clear_bits(map, MT6323_AUXADC_CON19,
AUXADC_CON19_DECI_GDLY_MASK);
}
static int mt6323_auxadc_request(struct mt6323_auxadc *auxadc,
unsigned long channel)
{
struct regmap *map = auxadc->regmap;
int ret;
ret = regmap_set_bits(map, MT6323_AUXADC_CON11, AUXADC_CON11_VBUF_EN);
if (ret)
return ret;
return regmap_set_bits(map, MT6323_AUXADC_CON22, BIT(channel));
}
static int mt6323_auxadc_release(struct mt6323_auxadc *auxadc,
unsigned long channel)
{
struct regmap *map = auxadc->regmap;
int ret;
ret = regmap_clear_bits(map, MT6323_AUXADC_CON22, BIT(channel));
if (ret)
return ret;
return regmap_clear_bits(map, MT6323_AUXADC_CON11, AUXADC_CON11_VBUF_EN);
}
static int mt6323_auxadc_read(struct mt6323_auxadc *auxadc,
const struct iio_chan_spec *chan, int *out)
{
struct regmap *map = auxadc->regmap;
u32 val;
int ret;
ret = regmap_read_poll_timeout(map, chan->address,
val, (val & AUXADC_READY_MASK),
1 * USEC_PER_MSEC, 100 * USEC_PER_MSEC);
if (ret)
return ret;
*out = FIELD_GET(AUXADC_DATA_MASK, val);
return 0;
}
static int mt6323_auxadc_read_raw(struct iio_dev *indio_dev,
const struct iio_chan_spec *chan,
int *val, int *val2, long mask)
{
struct mt6323_auxadc *auxadc = iio_priv(indio_dev);
int ret, mult;
switch (mask) {
case IIO_CHAN_INFO_SCALE:
if (chan->channel == MT6323_AUXADC_ISENSE ||
chan->channel == MT6323_AUXADC_BATSNS)
mult = 4;
else
mult = 1;
*val = mult * 1800;
*val2 = 15;
return IIO_VAL_FRACTIONAL_LOG2;
case IIO_CHAN_INFO_RAW: {
guard(mutex)(&auxadc->lock);
ret = mt6323_auxadc_prepare_channel(auxadc);
if (ret)
return ret;
ret = mt6323_auxadc_request(auxadc, chan->channel);
if (ret)
return ret;
fsleep(300);
ret = mt6323_auxadc_read(auxadc, chan, val);
if (mt6323_auxadc_release(auxadc, chan->channel))
dev_err(&indio_dev->dev,
"failed to release channel %d\n", chan->channel);
if (ret)
return ret;
return IIO_VAL_INT;
}
default:
return -EINVAL;
}
}
static int mt6323_auxadc_init(struct mt6323_auxadc *auxadc)
{
struct regmap *map = auxadc->regmap;
int ret;
ret = regmap_set_bits(map, MT6323_STRUP_CON10,
AUXADC_STRUP_CON10_RSTB_SW |
AUXADC_STRUP_CON10_RSTB_SEL);
if (ret)
return ret;
ret = regmap_set_bits(map, MT6323_TOP_CKPDN2, AUXADC_TOP_CKPDN2_CTL_CK);
if (ret)
return ret;
ret = regmap_update_bits(map, MT6323_AUXADC_CON10,
AUXADC_TRIM_CH2_MASK | AUXADC_TRIM_CH4_MASK |
AUXADC_TRIM_CH5_MASK | AUXADC_TRIM_CH6_MASK,
FIELD_PREP(AUXADC_TRIM_CH2_MASK, 1) |
FIELD_PREP(AUXADC_TRIM_CH4_MASK, 1) |
FIELD_PREP(AUXADC_TRIM_CH5_MASK, 1) |
FIELD_PREP(AUXADC_TRIM_CH6_MASK, 1));
if (ret)
return ret;
ret = regmap_set_bits(map, MT6323_AUXADC_CON27,
AUXADC_CON27_VREF18_ENB_MD |
AUXADC_CON27_MD_STATUS);
if (ret)
return ret;
ret = regmap_set_bits(map, MT6323_AUXADC_CON19, AUXADC_CON19_GPS_STATUS);
if (ret)
return ret;
ret = regmap_set_bits(map, MT6323_AUXADC_CON26,
AUXADC_CON26_VREF18_SELB |
AUXADC_CON26_DECI_GDLY_SEL);
if (ret)
return ret;
return regmap_update_bits(map, MT6323_AUXADC_CON9, AUXADC_CON9_OSR_MASK,
FIELD_PREP(AUXADC_CON9_OSR_MASK, AUXADC_DEFAULT_OSR));
}
static const struct iio_info mt6323_auxadc_iio_info = {
.read_raw = mt6323_auxadc_read_raw,
};
static int mt6323_auxadc_probe(struct platform_device *pdev)
{
struct device *dev = &pdev->dev;
struct mt6323_auxadc *auxadc;
struct regmap *regmap;
struct iio_dev *iio;
int ret;
regmap = dev_get_regmap(dev->parent->parent, NULL);
if (!regmap)
return dev_err_probe(dev, -ENODEV, "failed to get regmap\n");
iio = devm_iio_device_alloc(dev, sizeof(*auxadc));
if (!iio)
return -ENOMEM;
auxadc = iio_priv(iio);
auxadc->regmap = regmap;
ret = devm_mutex_init(dev, &auxadc->lock);
if (ret)
return ret;
ret = mt6323_auxadc_init(auxadc);
if (ret)
return dev_err_probe(dev, ret, "failed to initialize auxadc\n");
iio->name = "mt6323-auxadc";
iio->info = &mt6323_auxadc_iio_info;
iio->modes = INDIO_DIRECT_MODE;
iio->channels = mt6323_auxadc_channels;
iio->num_channels = ARRAY_SIZE(mt6323_auxadc_channels);
return devm_iio_device_register(dev, iio);
}
static const struct of_device_id mt6323_auxadc_of_match[] = {
{ .compatible = "mediatek,mt6323-auxadc" },
{ }
};
MODULE_DEVICE_TABLE(of, mt6323_auxadc_of_match);
static struct platform_driver mt6323_auxadc_driver = {
.driver = {
.name = "mt6323-auxadc",
.of_match_table = mt6323_auxadc_of_match,
},
.probe = mt6323_auxadc_probe,
};
module_platform_driver(mt6323_auxadc_driver);
MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("MediaTek MT6323 PMIC AUXADC Driver"