iqs620at-temp.c 2.4 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Azoteq IQS620AT Temperature Sensor
  4. *
  5. * Copyright (C) 2019 Jeff LaBundy <[email protected]>
  6. */
  7. #include <linux/device.h>
  8. #include <linux/iio/iio.h>
  9. #include <linux/kernel.h>
  10. #include <linux/mfd/iqs62x.h>
  11. #include <linux/module.h>
  12. #include <linux/platform_device.h>
  13. #include <linux/regmap.h>
  14. #define IQS620_TEMP_UI_OUT 0x1A
  15. #define IQS620_TEMP_SCALE 1000
  16. #define IQS620_TEMP_OFFSET (-100)
  17. #define IQS620_TEMP_OFFSET_V3 (-40)
  18. static int iqs620_temp_read_raw(struct iio_dev *indio_dev,
  19. struct iio_chan_spec const *chan,
  20. int *val, int *val2, long mask)
  21. {
  22. struct iqs62x_core *iqs62x = iio_device_get_drvdata(indio_dev);
  23. int ret;
  24. __le16 val_buf;
  25. switch (mask) {
  26. case IIO_CHAN_INFO_RAW:
  27. ret = regmap_raw_read(iqs62x->regmap, IQS620_TEMP_UI_OUT,
  28. &val_buf, sizeof(val_buf));
  29. if (ret)
  30. return ret;
  31. *val = le16_to_cpu(val_buf);
  32. return IIO_VAL_INT;
  33. case IIO_CHAN_INFO_SCALE:
  34. *val = IQS620_TEMP_SCALE;
  35. return IIO_VAL_INT;
  36. case IIO_CHAN_INFO_OFFSET:
  37. *val = iqs62x->hw_num < IQS620_HW_NUM_V3 ? IQS620_TEMP_OFFSET
  38. : IQS620_TEMP_OFFSET_V3;
  39. return IIO_VAL_INT;
  40. default:
  41. return -EINVAL;
  42. }
  43. }
  44. static const struct iio_info iqs620_temp_info = {
  45. .read_raw = &iqs620_temp_read_raw,
  46. };
  47. static const struct iio_chan_spec iqs620_temp_channels[] = {
  48. {
  49. .type = IIO_TEMP,
  50. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
  51. BIT(IIO_CHAN_INFO_SCALE) |
  52. BIT(IIO_CHAN_INFO_OFFSET),
  53. },
  54. };
  55. static int iqs620_temp_probe(struct platform_device *pdev)
  56. {
  57. struct iqs62x_core *iqs62x = dev_get_drvdata(pdev->dev.parent);
  58. struct iio_dev *indio_dev;
  59. indio_dev = devm_iio_device_alloc(&pdev->dev, 0);
  60. if (!indio_dev)
  61. return -ENOMEM;
  62. iio_device_set_drvdata(indio_dev, iqs62x);
  63. indio_dev->modes = INDIO_DIRECT_MODE;
  64. indio_dev->channels = iqs620_temp_channels;
  65. indio_dev->num_channels = ARRAY_SIZE(iqs620_temp_channels);
  66. indio_dev->name = iqs62x->dev_desc->dev_name;
  67. indio_dev->info = &iqs620_temp_info;
  68. return devm_iio_device_register(&pdev->dev, indio_dev);
  69. }
  70. static struct platform_driver iqs620_temp_platform_driver = {
  71. .driver = {
  72. .name = "iqs620at-temp",
  73. },
  74. .probe = iqs620_temp_probe,
  75. };
  76. module_platform_driver(iqs620_temp_platform_driver);
  77. MODULE_AUTHOR("Jeff LaBundy <[email protected]>");
  78. MODULE_DESCRIPTION("Azoteq IQS620AT Temperature Sensor");
  79. MODULE_LICENSE("GPL");
  80. MODULE_ALIAS("platform:iqs620at-temp");