hc
2024-05-16 8d2a02b24d66aa359e83eebc1ed3c0f85367a1cb
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
97
98
99
100
101
102
103
104
105
106
107
108
109
110
// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * AD714X CapTouch Programmable Controller driver (I2C bus)
 *
 * Copyright 2009-2011 Analog Devices Inc.
 */
 
#include <linux/input.h>    /* BUS_I2C */
#include <linux/i2c.h>
#include <linux/module.h>
#include <linux/types.h>
#include <linux/pm.h>
#include "ad714x.h"
 
static int __maybe_unused ad714x_i2c_suspend(struct device *dev)
{
   return ad714x_disable(i2c_get_clientdata(to_i2c_client(dev)));
}
 
static int __maybe_unused ad714x_i2c_resume(struct device *dev)
{
   return ad714x_enable(i2c_get_clientdata(to_i2c_client(dev)));
}
 
static SIMPLE_DEV_PM_OPS(ad714x_i2c_pm, ad714x_i2c_suspend, ad714x_i2c_resume);
 
static int ad714x_i2c_write(struct ad714x_chip *chip,
               unsigned short reg, unsigned short data)
{
   struct i2c_client *client = to_i2c_client(chip->dev);
   int error;
 
   chip->xfer_buf[0] = cpu_to_be16(reg);
   chip->xfer_buf[1] = cpu_to_be16(data);
 
   error = i2c_master_send(client, (u8 *)chip->xfer_buf,
               2 * sizeof(*chip->xfer_buf));
   if (unlikely(error < 0)) {
       dev_err(&client->dev, "I2C write error: %d\n", error);
       return error;
   }
 
   return 0;
}
 
static int ad714x_i2c_read(struct ad714x_chip *chip,
              unsigned short reg, unsigned short *data, size_t len)
{
   struct i2c_client *client = to_i2c_client(chip->dev);
   int i;
   int error;
 
   chip->xfer_buf[0] = cpu_to_be16(reg);
 
   error = i2c_master_send(client, (u8 *)chip->xfer_buf,
               sizeof(*chip->xfer_buf));
   if (error >= 0)
       error = i2c_master_recv(client, (u8 *)chip->xfer_buf,
                   len * sizeof(*chip->xfer_buf));
 
   if (unlikely(error < 0)) {
       dev_err(&client->dev, "I2C read error: %d\n", error);
       return error;
   }
 
   for (i = 0; i < len; i++)
       data[i] = be16_to_cpu(chip->xfer_buf[i]);
 
   return 0;
}
 
static int ad714x_i2c_probe(struct i2c_client *client,
                   const struct i2c_device_id *id)
{
   struct ad714x_chip *chip;
 
   chip = ad714x_probe(&client->dev, BUS_I2C, client->irq,
               ad714x_i2c_read, ad714x_i2c_write);
   if (IS_ERR(chip))
       return PTR_ERR(chip);
 
   i2c_set_clientdata(client, chip);
 
   return 0;
}
 
static const struct i2c_device_id ad714x_id[] = {
   { "ad7142_captouch", 0 },
   { "ad7143_captouch", 0 },
   { "ad7147_captouch", 0 },
   { "ad7147a_captouch", 0 },
   { "ad7148_captouch", 0 },
   { }
};
MODULE_DEVICE_TABLE(i2c, ad714x_id);
 
static struct i2c_driver ad714x_i2c_driver = {
   .driver = {
       .name = "ad714x_captouch",
       .pm   = &ad714x_i2c_pm,
   },
   .probe    = ad714x_i2c_probe,
   .id_table = ad714x_id,
};
 
module_i2c_driver(ad714x_i2c_driver);
 
MODULE_DESCRIPTION("Analog Devices AD714X Capacitance Touch Sensor I2C Bus Driver");
MODULE_AUTHOR("Barry Song <21cnbao@gmail.com>");
MODULE_LICENSE("GPL");