Quelle  gehc-pmc-adc.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * The GE HealthCare PMC ADC is a 16-Channel (Voltage and current), 16-Bit
 * ADC with an I2C Interface.
 *
 * Copyright (C) 2024, GE HealthCare
 *
 * Authors:
 * Herve Codina <herve.codina@bootlin.com>
 */
#include <dt-bindings/iio/adc/gehc,pmc-adc.h>
#include <linux/bitops.h>
#include <linux/clk.h>
#include <linux/i2c.h>
#include <linux/iio/iio.h>
#include <linux/module.h>
#include <linux/regulator/consumer.h>
#include <linux/slab.h>

struct pmc_adc {
 struct i2c_client *client;
};

#define PMC_ADC_CMD_REQUEST_PROTOCOL_VERSION 0x01
#define PMC_ADC_CMD_READ_VOLTAGE(_ch)  (0x10 | (_ch))
#define PMC_ADC_CMD_READ_CURRENT(_ch)  (0x20 | (_ch))

#define PMC_ADC_VOLTAGE_CHANNEL(_ch, _ds_name) {   \
 .type = IIO_VOLTAGE,      \
 .indexed = 1,       \
 .channel = (_ch),      \
 .address = PMC_ADC_CMD_READ_VOLTAGE(_ch),   \
 .info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),  \
 .datasheet_name = (_ds_name),     \
}

#define PMC_ADC_CURRENT_CHANNEL(_ch, _ds_name) {   \
 .type = IIO_CURRENT,      \
 .indexed = 1,       \
 .channel = (_ch),      \
 .address = PMC_ADC_CMD_READ_CURRENT(_ch),   \
 .info_mask_separate = BIT(IIO_CHAN_INFO_PROCESSED),  \
 .datasheet_name = (_ds_name),     \
}

static const struct iio_chan_spec pmc_adc_channels[] = {
 PMC_ADC_VOLTAGE_CHANNEL(0, "CH0_V"),
 PMC_ADC_VOLTAGE_CHANNEL(1, "CH1_V"),
 PMC_ADC_VOLTAGE_CHANNEL(2, "CH2_V"),
 PMC_ADC_VOLTAGE_CHANNEL(3, "CH3_V"),
 PMC_ADC_VOLTAGE_CHANNEL(4, "CH4_V"),
 PMC_ADC_VOLTAGE_CHANNEL(5, "CH5_V"),
 PMC_ADC_VOLTAGE_CHANNEL(6, "CH6_V"),
 PMC_ADC_VOLTAGE_CHANNEL(7, "CH7_V"),
 PMC_ADC_VOLTAGE_CHANNEL(8, "CH8_V"),
 PMC_ADC_VOLTAGE_CHANNEL(9, "CH9_V"),
 PMC_ADC_VOLTAGE_CHANNEL(10, "CH10_V"),
 PMC_ADC_VOLTAGE_CHANNEL(11, "CH11_V"),
 PMC_ADC_VOLTAGE_CHANNEL(12, "CH12_V"),
 PMC_ADC_VOLTAGE_CHANNEL(13, "CH13_V"),
 PMC_ADC_VOLTAGE_CHANNEL(14, "CH14_V"),
 PMC_ADC_VOLTAGE_CHANNEL(15, "CH15_V"),

 PMC_ADC_CURRENT_CHANNEL(0, "CH0_I"),
 PMC_ADC_CURRENT_CHANNEL(1, "CH1_I"),
 PMC_ADC_CURRENT_CHANNEL(2, "CH2_I"),
 PMC_ADC_CURRENT_CHANNEL(3, "CH3_I"),
 PMC_ADC_CURRENT_CHANNEL(4, "CH4_I"),
 PMC_ADC_CURRENT_CHANNEL(5, "CH5_I"),
 PMC_ADC_CURRENT_CHANNEL(6, "CH6_I"),
 PMC_ADC_CURRENT_CHANNEL(7, "CH7_I"),
 PMC_ADC_CURRENT_CHANNEL(8, "CH8_I"),
 PMC_ADC_CURRENT_CHANNEL(9, "CH9_I"),
 PMC_ADC_CURRENT_CHANNEL(10, "CH10_I"),
 PMC_ADC_CURRENT_CHANNEL(11, "CH11_I"),
 PMC_ADC_CURRENT_CHANNEL(12, "CH12_I"),
 PMC_ADC_CURRENT_CHANNEL(13, "CH13_I"),
 PMC_ADC_CURRENT_CHANNEL(14, "CH14_I"),
 PMC_ADC_CURRENT_CHANNEL(15, "CH15_I"),
};

static int pmc_adc_read_raw_ch(struct pmc_adc *pmc_adc, u8 cmd, int *val)
{
 s32 ret;

 ret = i2c_smbus_read_word_swapped(pmc_adc->client, cmd);
 if (ret < 0) {
  dev_err(&pmc_adc->client->dev, "i2c read word failed (%d)\n", ret);
  return ret;
 }

 *val = sign_extend32(ret, 15);
 return 0;
}

static int pmc_adc_read_raw(struct iio_dev *indio_dev, struct iio_chan_spec const *chan,
       int *val, int *val2, long mask)
{
 struct pmc_adc *pmc_adc = iio_priv(indio_dev);
 int ret;

 switch (mask) {
 case IIO_CHAN_INFO_PROCESSED:
  /* Values are directly read in mV or mA */
  ret = pmc_adc_read_raw_ch(pmc_adc, chan->address, val);
  if (ret)
   return ret;
  return IIO_VAL_INT;
 }

 return -EINVAL;
}

static int pmc_adc_fwnode_xlate(struct iio_dev *indio_dev,
    const struct fwnode_reference_args *iiospec)
{
 enum iio_chan_type expected_type;
 unsigned int i;

 /*
 * args[0]: Acquisition type (i.e. voltage or current)
 * args[1]: PMC ADC channel number
 */
 if (iiospec->nargs != 2)
  return -EINVAL;

 switch (iiospec->args[0]) {
 case GEHC_PMC_ADC_VOLTAGE:
  expected_type = IIO_VOLTAGE;
  break;
 case GEHC_PMC_ADC_CURRENT:
  expected_type = IIO_CURRENT;
  break;
 default:
  dev_err(&indio_dev->dev, "Invalid channel type %llu\n",
   iiospec->args[0]);
  return -EINVAL;
 }

 for (i = 0; i < indio_dev->num_channels; i++)
  if (indio_dev->channels[i].type == expected_type &&
      indio_dev->channels[i].channel == iiospec->args[1])
   return i;

 dev_err(&indio_dev->dev, "Invalid channel type %llu number %llu\n",
  iiospec->args[0], iiospec->args[1]);
 return -EINVAL;
}

static const struct iio_info pmc_adc_info = {
 .read_raw = pmc_adc_read_raw,
 .fwnode_xlate = pmc_adc_fwnode_xlate,
};

static const char *const pmc_adc_regulator_names[] = {
 "vdd",
 "vdda",
 "vddio",
 "vref",
};

static int pmc_adc_probe(struct i2c_client *client)
{
 struct iio_dev *indio_dev;
 struct pmc_adc *pmc_adc;
 struct clk *clk;
 s32 val;
 int ret;

 ret = devm_regulator_bulk_get_enable(&client->dev, ARRAY_SIZE(pmc_adc_regulator_names),
          pmc_adc_regulator_names);
 if (ret)
  return dev_err_probe(&client->dev, ret, "Failed to get regulators\n");

 clk = devm_clk_get_optional_enabled(&client->dev, "osc");
 if (IS_ERR(clk))
  return dev_err_probe(&client->dev, PTR_ERR(clk), "Failed to get osc clock\n");

 indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*pmc_adc));
 if (!indio_dev)
  return -ENOMEM;

 pmc_adc = iio_priv(indio_dev);
 pmc_adc->client = client;

 val = i2c_smbus_read_byte_data(pmc_adc->client, PMC_ADC_CMD_REQUEST_PROTOCOL_VERSION);
 if (val < 0)
  return dev_err_probe(&client->dev, val, "Failed to get protocol version\n");

 if (val != 0x01)
  return dev_err_probe(&client->dev, -EINVAL,
         "Unsupported protocol version 0x%02x\n", val);

 indio_dev->name = "pmc_adc";
 indio_dev->info = &pmc_adc_info;
 indio_dev->modes = INDIO_DIRECT_MODE;
 indio_dev->channels = pmc_adc_channels;
 indio_dev->num_channels = ARRAY_SIZE(pmc_adc_channels);

 return devm_iio_device_register(&client->dev, indio_dev);
}

static const struct of_device_id pmc_adc_of_match[] = {
 { .compatible = "gehc,pmc-adc"},
 { }
};
MODULE_DEVICE_TABLE(of, pmc_adc_of_match);

static const struct i2c_device_id pmc_adc_id_table[] = {
 { "pmc-adc" },
 { }
};
MODULE_DEVICE_TABLE(i2c, pmc_adc_id_table);

static struct i2c_driver pmc_adc_i2c_driver = {
 .driver  = {
  .name = "pmc-adc",
  .of_match_table = pmc_adc_of_match,
 },
 .id_table = pmc_adc_id_table,
 .probe  = pmc_adc_probe,
};

module_i2c_driver(pmc_adc_i2c_driver);

MODULE_AUTHOR("Herve Codina ");
MODULE_DESCRIPTION("GE HealthCare PMC ADC driver");
MODULE_LICENSE("GPL");