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