/* SPDX-License-Identifier: GPL-2.0 */ /* * Copyright (c) 2019 MediaTek Inc. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #if defined(CONFIG_MTK_PMIC_CHIP_MT6357) #include #elif defined(CONFIG_MTK_PMIC_CHIP_MT6358) #include #elif defined(CONFIG_MTK_PMIC_CHIP_MT6359) #include #elif defined(CONFIG_MTK_PMIC_CHIP_MT6359P) #include #elif defined(CONFIG_MTK_PMIC_CHIP_MT6390) #include #endif #define AUXADC_RDY_SHIFT 15 #define AUXADC_DEF_R_RATIO 1 #define AUXADC_DEF_AVG_NUM 8 #define AUXADC_AVG_TIME_US 10 #define MAX_TIMEOUT_COUNT 160 /* 100us-200us * 160 = 16ms-32ms */ #define VOLT_FULL 1800 struct mt635x_auxadc_device { unsigned int chip_id; struct regmap *regmap; struct device *dev; unsigned int nchannels; struct iio_chan_spec *iio_chans; struct mutex lock; const struct auxadc_regs *auxadc_regs_tbl; const unsigned int *dbg_regs; unsigned int num_dbg_regs; const unsigned int (*rst_setting)[3]; unsigned int num_rst_setting; }; /* * @res: ADC resolution * @r_ratio: resistance ratio, represented by r_ratio[0] / r_ratio[1] */ struct auxadc_channels { enum iio_chan_type type; long info_mask; /* AUXADC channel attribute */ const char *ch_name; unsigned char ch_num; unsigned char res; unsigned char r_ratio[2]; unsigned short avg_num; const struct auxadc_regs *regs; void (*convert_fn)(unsigned char convert); int (*cali_fn)(int val, int precision_factor); }; #define MT635x_AUXADC_CHANNEL(_ch_name, _ch_num, _res) \ [AUXADC_##_ch_name] = { \ .type = IIO_VOLTAGE, \ .info_mask = BIT(IIO_CHAN_INFO_RAW) | \ BIT(IIO_CHAN_INFO_PROCESSED), \ .ch_name = __stringify(_ch_name), \ .ch_num = _ch_num, \ .res = _res, \ } \ /* * The array represents all possible ADC channels found in the supported PMICs. * Every index in the array is equal to the channel number per datasheet. The * gaps in the array should be treated as reserved channels. */ static struct auxadc_channels auxadc_chans[] = { MT635x_AUXADC_CHANNEL(BATADC, 0, 15), MT635x_AUXADC_CHANNEL(ISENSE, 0, 15), MT635x_AUXADC_CHANNEL(VCDT, 2, 12), MT635x_AUXADC_CHANNEL(BAT_TEMP, 3, 12), MT635x_AUXADC_CHANNEL(BATID, 3, 12), MT635x_AUXADC_CHANNEL(CHIP_TEMP, 4, 12), MT635x_AUXADC_CHANNEL(VCORE_TEMP, 4, 12), MT635x_AUXADC_CHANNEL(VPROC_TEMP, 4, 12), MT635x_AUXADC_CHANNEL(VGPU_TEMP, 4, 12), MT635x_AUXADC_CHANNEL(ACCDET, 5, 12), MT635x_AUXADC_CHANNEL(VDCXO, 6, 12), MT635x_AUXADC_CHANNEL(TSX_TEMP, 7, 15), MT635x_AUXADC_CHANNEL(HPOFS_CAL, 9, 15), MT635x_AUXADC_CHANNEL(DCXO_TEMP, 10, 15), MT635x_AUXADC_CHANNEL(VBIF, 11, 12), }; struct auxadc_regs { unsigned int rqst_reg; unsigned int rqst_shift; unsigned int out_reg; }; #define MT635x_AUXADC_REG(_ch_name, _chip, _rqst_reg, _rqst_shift, _out_reg) \ [AUXADC_##_ch_name] = { \ .rqst_reg = _chip##_##_rqst_reg, \ .rqst_shift = _rqst_shift, \ .out_reg = _chip##_##_out_reg, \ } \ static const struct auxadc_regs mt6357_auxadc_regs_tbl[] = { #if defined(CONFIG_MTK_PMIC_CHIP_MT6357) MT635x_AUXADC_REG(BATADC, MT6357, AUXADC_RQST0, 0, AUXADC_ADC0), MT635x_AUXADC_REG(ISENSE, MT6357, AUXADC_RQST0, 1, AUXADC_ADC1), MT635x_AUXADC_REG(VCDT, MT6357, AUXADC_RQST0, 2, AUXADC_ADC2), MT635x_AUXADC_REG(BAT_TEMP, MT6357, AUXADC_RQST0, 3, AUXADC_ADC3), MT635x_AUXADC_REG(CHIP_TEMP, MT6357, AUXADC_RQST0, 4, AUXADC_ADC4), MT635x_AUXADC_REG(VCORE_TEMP, MT6357, AUXADC_RQST2, 5, AUXADC_ADC46), MT635x_AUXADC_REG(VPROC_TEMP, MT6357, AUXADC_RQST2, 6, AUXADC_ADC47), MT635x_AUXADC_REG(ACCDET, MT6357, AUXADC_RQST0, 5, AUXADC_ADC5), MT635x_AUXADC_REG(TSX_TEMP, MT6357, AUXADC_RQST0, 7, AUXADC_ADC7), MT635x_AUXADC_REG(HPOFS_CAL, MT6357, AUXADC_RQST0, 9, AUXADC_ADC9), MT635x_AUXADC_REG(DCXO_TEMP, MT6357, AUXADC_RQST0, 4, AUXADC_ADC40), MT635x_AUXADC_REG(VBIF, MT6357, AUXADC_RQST0, 11, AUXADC_ADC11), #endif #if defined(CONFIG_MTK_PMIC_CHIP_MT6390) MT635x_AUXADC_REG(BATADC, MT6390, AUXADC_RQST0, 0, AUXADC_ADC0), MT635x_AUXADC_REG(ISENSE, MT6390, AUXADC_RQST0, 1, AUXADC_ADC1), MT635x_AUXADC_REG(VCDT, MT6390, AUXADC_RQST0, 2, AUXADC_ADC2), MT635x_AUXADC_REG(BAT_TEMP, MT6390, AUXADC_RQST0, 3, AUXADC_ADC3), MT635x_AUXADC_REG(CHIP_TEMP, MT6390, AUXADC_RQST0, 4, AUXADC_ADC4), MT635x_AUXADC_REG(VCORE_TEMP, MT6390, AUXADC_RQST2, 5, AUXADC_ADC46), MT635x_AUXADC_REG(VPROC_TEMP, MT6390, AUXADC_RQST2, 6, AUXADC_ADC47), MT635x_AUXADC_REG(ACCDET, MT6390, AUXADC_RQST0, 5, AUXADC_ADC5), MT635x_AUXADC_REG(TSX_TEMP, MT6390, AUXADC_RQST0, 7, AUXADC_ADC7), MT635x_AUXADC_REG(HPOFS_CAL, MT6390, AUXADC_RQST0, 9, AUXADC_ADC9), MT635x_AUXADC_REG(DCXO_TEMP, MT6390, AUXADC_RQST0, 4, AUXADC_ADC40), MT635x_AUXADC_REG(VBIF, MT6390, AUXADC_RQST0, 11, AUXADC_ADC11), #endif }; static const struct auxadc_regs mt6358_auxadc_regs_tbl[] = { #if defined(CONFIG_MTK_PMIC_CHIP_MT6358) MT635x_AUXADC_REG(BATADC, MT6358, AUXADC_RQST0, 0, AUXADC_ADC0), MT635x_AUXADC_REG(VCDT, MT6358, AUXADC_RQST0, 2, AUXADC_ADC2), MT635x_AUXADC_REG(BAT_TEMP, MT6358, AUXADC_RQST0, 3, AUXADC_ADC3), MT635x_AUXADC_REG(CHIP_TEMP, MT6358, AUXADC_RQST0, 4, AUXADC_ADC4), MT635x_AUXADC_REG(VCORE_TEMP, MT6358, AUXADC_RQST1, 8, AUXADC_ADC38), MT635x_AUXADC_REG(VPROC_TEMP, MT6358, AUXADC_RQST1, 9, AUXADC_ADC39), MT635x_AUXADC_REG(VGPU_TEMP, MT6358, AUXADC_RQST1, 10, AUXADC_ADC40), MT635x_AUXADC_REG(ACCDET, MT6358, AUXADC_RQST0, 5, AUXADC_ADC5), MT635x_AUXADC_REG(VDCXO, MT6358, AUXADC_RQST0, 6, AUXADC_ADC6), MT635x_AUXADC_REG(TSX_TEMP, MT6358, AUXADC_RQST0, 7, AUXADC_ADC7), MT635x_AUXADC_REG(HPOFS_CAL, MT6358, AUXADC_RQST0, 9, AUXADC_ADC9), MT635x_AUXADC_REG(DCXO_TEMP, MT6358, AUXADC_RQST0, 10, AUXADC_ADC10), MT635x_AUXADC_REG(VBIF, MT6358, AUXADC_RQST0, 11, AUXADC_ADC11), #endif }; static const struct auxadc_regs mt6359_auxadc_regs_tbl[] = { #if defined(CONFIG_MTK_PMIC_CHIP_MT6359) \ || defined(CONFIG_MTK_PMIC_CHIP_MT6359P) MT635x_AUXADC_REG(BATADC, MT6359, AUXADC_RQST0, 0, AUXADC_ADC0), MT635x_AUXADC_REG(VCDT, MT6359, AUXADC_RQST0, 2, AUXADC_ADC2), MT635x_AUXADC_REG(BAT_TEMP, MT6359, AUXADC_RQST0, 3, AUXADC_ADC3), MT635x_AUXADC_REG(CHIP_TEMP, MT6359, AUXADC_RQST0, 4, AUXADC_ADC4), MT635x_AUXADC_REG(VCORE_TEMP, MT6359, AUXADC_RQST1, 8, AUXADC_ADC38), MT635x_AUXADC_REG(VPROC_TEMP, MT6359, AUXADC_RQST1, 9, AUXADC_ADC39), MT635x_AUXADC_REG(VGPU_TEMP, MT6359, AUXADC_RQST1, 10, AUXADC_ADC40), MT635x_AUXADC_REG(ACCDET, MT6359, AUXADC_RQST0, 5, AUXADC_ADC5), MT635x_AUXADC_REG(VDCXO, MT6359, AUXADC_RQST0, 6, AUXADC_ADC6), MT635x_AUXADC_REG(TSX_TEMP, MT6359, AUXADC_RQST0, 7, AUXADC_ADC7), MT635x_AUXADC_REG(HPOFS_CAL, MT6359, AUXADC_RQST0, 9, AUXADC_ADC9), MT635x_AUXADC_REG(DCXO_TEMP, MT6359, AUXADC_RQST0, 10, AUXADC_ADC10), MT635x_AUXADC_REG(VBIF, MT6359, AUXADC_RQST0, 11, AUXADC_ADC11), #endif }; static const unsigned int mt6357_dbg_regs[] = { #if defined(CONFIG_MTK_PMIC_CHIP_MT6357) MT6357_AUXADC_STA0, MT6357_AUXADC_STA1, MT6357_AUXADC_STA2, MT6357_STRUP_CON6, MT6357_HK_TOP_RST_CON0, MT6357_HK_TOP_CLK_CON0, MT6357_HK_TOP_CLK_CON1, #endif #if defined(CONFIG_MTK_PMIC_CHIP_MT6390) MT6390_AUXADC_STA0, MT6390_AUXADC_STA1, MT6390_AUXADC_STA2, MT6390_STRUP_CON6, MT6390_HK_TOP_RST_CON0, MT6390_HK_TOP_CLK_CON0, MT6390_HK_TOP_CLK_CON1, #endif }; static const unsigned int mt6358_dbg_regs[] = { #if defined(CONFIG_MTK_PMIC_CHIP_MT6358) MT6358_AUXADC_STA0, MT6358_AUXADC_STA1, MT6358_AUXADC_STA2, MT6358_STRUP_CON6, MT6358_HK_TOP_RST_CON0, MT6358_HK_TOP_CLK_CON0, MT6358_HK_TOP_CLK_CON1, MT6358_AUXADC_CON20, /* check DATA_REUSE */ #endif }; static const unsigned int mt6359_dbg_regs[] = { #if defined(CONFIG_MTK_PMIC_CHIP_MT6359) \ || defined(CONFIG_MTK_PMIC_CHIP_MT6359P) MT6359_AUXADC_STA0, MT6359_AUXADC_STA1, MT6359_AUXADC_STA2, MT6359_AUXADC_CON5, MT6359_AUXADC_CON9, MT6359_AUXADC_CON21, MT6359_HK_TOP_LDO_STATUS, MT6359_AUXADC_NAG_9, MT6359_AUXADC_NAG_10, MT6359_AUXADC_NAG_11, MT6359_AUXADC_IMP3, MT6359_AUXADC_IMP4, MT6359_AUXADC_IMP5, MT6359_AUXADC_LBAT6, MT6359_AUXADC_LBAT7, MT6359_AUXADC_LBAT8, MT6359_AUXADC_BAT_TEMP_7, MT6359_AUXADC_BAT_TEMP_8, MT6359_AUXADC_BAT_TEMP_9, MT6359_AUXADC_LBAT2_6, MT6359_AUXADC_LBAT2_7, MT6359_AUXADC_LBAT2_8, MT6359_AUXADC_MDRT_3, MT6359_AUXADC_MDRT_4, MT6359_AUXADC_MDRT_5, MT6359_HK_TOP_STRUP, MT6359_HK_TOP_RST_CON0, MT6359_HK_TOP_CLK_CON0, MT6359_HK_TOP_CLK_CON1, MT6359_AUXADC_CON20, /* check DATA_REUSE */ #endif }; static const unsigned int mt6357_rst_setting[][3] = { #if defined(CONFIG_MTK_PMIC_CHIP_MT6357) { MT6357_HK_TOP_RST_CON0, 0x9, 0x9, }, { MT6357_HK_TOP_RST_CON0, 0x9, 0, }, { MT6357_AUXADC_RQST0, 0x80, 0x80, }, { MT6357_AUXADC_RQST1, 0x400, 0x400, } #endif #if defined(CONFIG_MTK_PMIC_CHIP_MT6390) { MT6390_HK_TOP_RST_CON0, 0x9, 0x9, }, { MT6390_HK_TOP_RST_CON0, 0x9, 0, }, { MT6390_AUXADC_RQST0, 0x80, 0x80, }, { MT6390_AUXADC_RQST1, 0x400, 0x400, } #endif }; static const unsigned int mt6358_rst_setting[][3] = { #if defined(CONFIG_MTK_PMIC_CHIP_MT6358) { MT6358_HK_TOP_RST_CON0, 0x9, 0x9, }, { MT6358_HK_TOP_RST_CON0, 0x9, 0, }, { MT6358_AUXADC_RQST0, 0x80, 0x80, }, { MT6358_AUXADC_RQST1, 0x40, 0x40, } #endif }; static const unsigned int mt6359_rst_setting[][3] = { #if defined(CONFIG_MTK_PMIC_CHIP_MT6359) \ || defined(CONFIG_MTK_PMIC_CHIP_MT6359P) { MT6359_HK_TOP_WKEY, 0xFFFF, 0x6359, }, { MT6359_HK_TOP_RST_CON0, 0x9, 0x9, }, { MT6359_HK_TOP_RST_CON0, 0x9, 0, }, { MT6359_HK_TOP_WKEY, 0xFFFF, 0, }, { MT6359_AUXADC_RQST0, 0x80, 0x80, }, { MT6359_AUXADC_RQST1, 0x40, 0x40, } #endif }; static unsigned short get_auxadc_out(struct mt635x_auxadc_device *adc_dev, int channel); /* Exported function for chip init */ void auxadc_set_convert_fn(unsigned int channel, void (*convert_fn)(unsigned char)) { auxadc_chans[channel].convert_fn = convert_fn; } void auxadc_set_cali_fn(unsigned int channel, int (*cali_fn)(int, int)) { auxadc_chans[channel].cali_fn = cali_fn; } int auxadc_priv_read_channel(struct device *dev, int channel) { const struct auxadc_channels *auxadc_chan; struct iio_dev *indio_dev; struct mt635x_auxadc_device *adc_dev; int val; auxadc_chan = &auxadc_chans[channel]; indio_dev = platform_get_drvdata(to_platform_device(dev)); adc_dev = iio_priv(indio_dev); val = (int)get_auxadc_out(adc_dev, channel); val = val * auxadc_chan->r_ratio[0] * VOLT_FULL; val = (val / auxadc_chan->r_ratio[1]) >> auxadc_chan->res; return val; } unsigned char *auxadc_get_r_ratio(int channel) { const struct auxadc_channels *auxadc_chan = &auxadc_chans[channel]; return (unsigned char *)auxadc_chan->r_ratio; } #define AUXADC_MAP(_adc_channel_label) \ { \ .adc_channel_label = _adc_channel_label, \ .consumer_dev_name = "mt635x-auxadc", \ .consumer_channel = "AUXADC_"_adc_channel_label,\ } /* for consumer drivers */ static struct iio_map mt635x_auxadc_default_maps[] = { AUXADC_MAP("BATADC"), AUXADC_MAP("ISENSE"), AUXADC_MAP("VCDT"), AUXADC_MAP("BAT_TEMP"), AUXADC_MAP("BATID"), AUXADC_MAP("CHIP_TEMP"), AUXADC_MAP("VCORE_TEMP"), AUXADC_MAP("VPROC_TEMP"), AUXADC_MAP("VGPU_TEMP"), AUXADC_MAP("ACCDET"), AUXADC_MAP("VDCXO"), AUXADC_MAP("TSX_TEMP"), AUXADC_MAP("HPOFS_CAL"), AUXADC_MAP("DCXO_TEMP"), AUXADC_MAP("VBIF"), {}, }; static void auxadc_reset(struct mt635x_auxadc_device *adc_dev) { int i; for (i = 0; i < adc_dev->num_rst_setting; i++) { regmap_update_bits(adc_dev->regmap, adc_dev->rst_setting[i][0], adc_dev->rst_setting[i][1], adc_dev->rst_setting[i][2]); } dev_notice(adc_dev->dev, "reset AUXADC done\n"); } static void auxadc_timeout_handler(struct mt635x_auxadc_device *adc_dev, bool is_timeout, unsigned char ch_num) { int i, ret; unsigned char reg_log[631] = "", reg_str[21] = ""; unsigned int reg_val = 0; static unsigned short timeout_times; if (is_timeout == false) { timeout_times = 0; return; } timeout_times++; for (i = 0; i < adc_dev->num_dbg_regs; i++) { regmap_read(adc_dev->regmap, adc_dev->dbg_regs[i], ®_val); ret = snprintf(reg_str, 20, "Reg[0x%x]=0x%x,", adc_dev->dbg_regs[i], reg_val); if (ret < 0) break; strncat(reg_log, reg_str, ARRAY_SIZE(reg_log) - 1); } dev_notice(adc_dev->dev, "(%d)Time out!(%d) %s\n", ch_num, timeout_times, reg_log); if (timeout_times == 11) auxadc_reset(adc_dev); } /* * @adc_dev: pointer to the struct mt635x_auxadc_device * @channel: channel number, refer to the auxadc_chans index pass from struct iio_chan_spec.channel */ static unsigned short get_auxadc_out(struct mt635x_auxadc_device *adc_dev, int channel) { unsigned int count = 0; unsigned int auxadc_out = 0; bool is_timeout = false; const struct auxadc_channels *auxadc_chan; auxadc_chan = &auxadc_chans[channel]; if (auxadc_chan->convert_fn) auxadc_chan->convert_fn(1); regmap_write(adc_dev->regmap, auxadc_chan->regs->rqst_reg, BIT(auxadc_chan->regs->rqst_shift)); udelay(auxadc_chan->avg_num * AUXADC_AVG_TIME_US); regmap_read(adc_dev->regmap, auxadc_chan->regs->out_reg, &auxadc_out); while (((auxadc_out >> AUXADC_RDY_SHIFT) & 0x1) != 1) { usleep_range(100, 200); if ((count++) > MAX_TIMEOUT_COUNT) { is_timeout = true; break; } regmap_read(adc_dev->regmap, auxadc_chan->regs->out_reg, &auxadc_out); } auxadc_out &= BIT(auxadc_chan->res) - 1; auxadc_timeout_handler(adc_dev, is_timeout, auxadc_chan->ch_num); if (auxadc_chan->convert_fn) auxadc_chan->convert_fn(0); return auxadc_out; } static int mt635x_auxadc_read_raw(struct iio_dev *indio_dev, struct iio_chan_spec const *chan, int *val, int *val2, long mask) { struct mt635x_auxadc_device *adc_dev = iio_priv(indio_dev); const struct auxadc_channels *auxadc_chan; unsigned short auxadc_out; int ret; static DEFINE_RATELIMIT_STATE(ratelimit, 1 * HZ, 5); mutex_lock(&adc_dev->lock); pm_stay_awake(adc_dev->dev); auxadc_out = get_auxadc_out(adc_dev, chan->channel); pm_relax(adc_dev->dev); mutex_unlock(&adc_dev->lock); auxadc_chan = &auxadc_chans[chan->channel]; switch (mask) { case IIO_CHAN_INFO_PROCESSED: *val = (int)(auxadc_out * auxadc_chan->r_ratio[0] * VOLT_FULL); *val = (*val / auxadc_chan->r_ratio[1]) >> auxadc_chan->res; if (auxadc_chan->cali_fn) *val = auxadc_chan->cali_fn(*val, 10); ret = IIO_VAL_INT; break; case IIO_CHAN_INFO_RAW: *val = (int)auxadc_out; ret = IIO_VAL_INT; break; default: return -EINVAL; } if (__ratelimit(&ratelimit)) { dev_info(adc_dev->dev, "name:%s, channel=%d, adc_out=0x%x, adc_result=%d\n", auxadc_chan->ch_name, auxadc_chan->ch_num, auxadc_out, *val); } return ret; } static int mt635x_auxadc_of_xlate(struct iio_dev *indio_dev, const struct of_phandle_args *iiospec) { int i; for (i = 0; i < indio_dev->num_channels; i++) { if (indio_dev->channels[i].channel == iiospec->args[0]) return i; } return -EINVAL; } static const struct iio_info mt635x_auxadc_info = { //.driver_module = THIS_MODULE, .read_raw = &mt635x_auxadc_read_raw, .of_xlate = &mt635x_auxadc_of_xlate, }; static int auxadc_get_data_from_dt(struct mt635x_auxadc_device *adc_dev, unsigned int *channel, struct device_node *node) { struct auxadc_channels *auxadc_chan; unsigned int value = 0, val_arr[2] = {0}; int ret; ret = of_property_read_u32(node, "channel", channel); if (ret) { dev_notice(adc_dev->dev, "invalid channel in node:%s\n", node->name); return ret; } if (*channel < AUXADC_CHAN_MIN || *channel > AUXADC_CHAN_MAX) { dev_notice(adc_dev->dev, "invalid channel number %d in node:%s\n", *channel, node->name); return ret; } auxadc_chan = &auxadc_chans[*channel]; ret = of_property_read_u32_array(node, "resistance-ratio", val_arr, 2); if (!ret) { auxadc_chan->r_ratio[0] = val_arr[0]; auxadc_chan->r_ratio[1] = val_arr[1]; } else { auxadc_chan->r_ratio[0] = AUXADC_DEF_R_RATIO; auxadc_chan->r_ratio[1] = 1; } ret = of_property_read_u32(node, "avg-num", &value); if (!ret) auxadc_chan->avg_num = value; else auxadc_chan->avg_num = AUXADC_DEF_AVG_NUM; return 0; } static int auxadc_parse_dt(struct mt635x_auxadc_device *adc_dev, struct device_node *node) { const struct auxadc_channels *auxadc_chan; struct iio_chan_spec *iio_chan; struct device_node *child; unsigned int channel = 0, index = 0; int ret; adc_dev->nchannels = of_get_available_child_count(node); if (!adc_dev->nchannels) return -EINVAL; adc_dev->iio_chans = devm_kcalloc(adc_dev->dev, adc_dev->nchannels, sizeof(*adc_dev->iio_chans), GFP_KERNEL); if (!adc_dev->iio_chans) return -ENOMEM; iio_chan = adc_dev->iio_chans; for_each_available_child_of_node(node, child) { ret = auxadc_get_data_from_dt(adc_dev, &channel, child); if (ret) { of_node_put(child); return ret; } auxadc_chans[channel].regs = &adc_dev->auxadc_regs_tbl[channel]; auxadc_chan = &auxadc_chans[channel]; iio_chan->channel = channel; iio_chan->datasheet_name = auxadc_chan->ch_name; iio_chan->extend_name = auxadc_chan->ch_name; iio_chan->info_mask_separate = auxadc_chan->info_mask; iio_chan->type = auxadc_chan->type; iio_chan->indexed = 1; iio_chan->address = index++; iio_chan++; } return 0; } static int mt635x_auxadc_probe(struct platform_device *pdev) { struct device_node *node = pdev->dev.of_node; struct mt635x_auxadc_device *adc_dev; struct iio_dev *indio_dev; struct mt6358_chip *chip; int ret; chip = dev_get_drvdata(pdev->dev.parent); indio_dev = devm_iio_device_alloc(&pdev->dev, sizeof(*adc_dev)); if (!indio_dev) return -ENOMEM; adc_dev = iio_priv(indio_dev); adc_dev->regmap = chip->regmap; adc_dev->dev = &pdev->dev; mutex_init(&adc_dev->lock); device_init_wakeup(&pdev->dev, true); adc_dev->chip_id = (uintptr_t)of_device_get_match_data(&pdev->dev); switch (adc_dev->chip_id) { case 0x6357: adc_dev->auxadc_regs_tbl = mt6357_auxadc_regs_tbl; adc_dev->dbg_regs = mt6357_dbg_regs; adc_dev->num_dbg_regs = ARRAY_SIZE(mt6357_dbg_regs); adc_dev->rst_setting = mt6357_rst_setting; adc_dev->num_rst_setting = ARRAY_SIZE(mt6357_rst_setting); break; case 0x6358: adc_dev->auxadc_regs_tbl = mt6358_auxadc_regs_tbl; adc_dev->dbg_regs = mt6358_dbg_regs; adc_dev->num_dbg_regs = ARRAY_SIZE(mt6358_dbg_regs); adc_dev->rst_setting = mt6358_rst_setting; adc_dev->num_rst_setting = ARRAY_SIZE(mt6358_rst_setting); break; case 0x6359: adc_dev->auxadc_regs_tbl = mt6359_auxadc_regs_tbl; adc_dev->dbg_regs = mt6359_dbg_regs; adc_dev->num_dbg_regs = ARRAY_SIZE(mt6359_dbg_regs); adc_dev->rst_setting = mt6359_rst_setting; adc_dev->num_rst_setting = ARRAY_SIZE(mt6359_rst_setting); break; default: break; } ret = auxadc_parse_dt(adc_dev, node); if (ret < 0) { dev_notice(&pdev->dev, "auxadc_parse_dt fail, ret=%d\n", ret); return ret; } indio_dev->dev.parent = &pdev->dev; indio_dev->name = dev_name(&pdev->dev); indio_dev->info = &mt635x_auxadc_info; indio_dev->modes = INDIO_DIRECT_MODE; indio_dev->channels = adc_dev->iio_chans; indio_dev->num_channels = adc_dev->nchannels; ret = iio_map_array_register(indio_dev, mt635x_auxadc_default_maps); if (ret) { dev_notice(&pdev->dev, "failed to register iio map:%d\n", ret); return ret; } platform_set_drvdata(pdev, indio_dev); ret = iio_device_register(indio_dev); if (ret < 0) { dev_notice(&pdev->dev, "failed to register iio device!\n"); iio_map_array_unregister(indio_dev); return ret; } dev_info(&pdev->dev, "%s done\n", __func__); ret = pmic_auxadc_chip_init(&pdev->dev); if (ret < 0) { dev_notice(&pdev->dev, "pmic_auxadc_chip_init fail, ret=%d\n", ret); return ret; } return 0; } static int mt635x_auxadc_remove(struct platform_device *pdev) { struct iio_dev *indio_dev = platform_get_drvdata(pdev); iio_device_unregister(indio_dev); iio_map_array_unregister(indio_dev); return 0; } static const struct of_device_id mt635x_auxadc_of_match[] = { { .compatible = "mediatek,mt6357-auxadc", .data = (void *)0x6357, }, { .compatible = "mediatek,mt6358-auxadc", .data = (void *)0x6358, }, { .compatible = "mediatek,mt6359-auxadc", .data = (void *)0x6359, }, { /* sentinel */ } }; MODULE_DEVICE_TABLE(of, mt635x_auxadc_of_match); static struct platform_driver mt635x_auxadc_driver = { .driver = { .name = "mt635x-auxadc", .of_match_table = mt635x_auxadc_of_match, }, .probe = mt635x_auxadc_probe, .remove = mt635x_auxadc_remove, }; #if 1 /* internal version */ static int __init mt635x_auxadc_driver_init(void) { return platform_driver_register(&mt635x_auxadc_driver); } fs_initcall(mt635x_auxadc_driver_init); #else module_platform_driver(mt635x_auxadc_driver); #endif MODULE_LICENSE("GPL v2"); MODULE_AUTHOR("Jeter Chen "); MODULE_DESCRIPTION("MediaTek PMIC AUXADC Driver for MT635x PMIC");