6b13f685e
김민수
BSP 최초 추가
|
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
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
|
#include <linux/module.h>
#include <linux/hwmon.h>
#include <linux/hwmon-sysfs.h>
#include <linux/i2c/ads1000.h>
#include <linux/i2c.h>
static ssize_t show
(struct device *dev,
struct device_attribute *da,
char *buf)
{
struct i2c_client *client = to_i2c_client(dev);
struct ads1000_platform_data *pdata = client->dev.platform_data;
s32 data = i2c_smbus_read_word_data(client, 0);
if (0 > data) {
pr_err("%s: error %d reading reg
",
__FILE__, data);
} else {
data = swab16(data);
}
if (pdata && pdata->denominator)
data = (data * pdata->numerator)/pdata->denominator;
else
pr_err("%s: invalid platform data
", __FILE__);
return (data < 0) ? data : sprintf(buf, "%d
", data);
}
static const struct sensor_device_attribute ads1000_attr =
SENSOR_ATTR(mv, S_IRUGO, show, NULL, 0);
static int ads1000_remove(struct i2c_client *client)
{
device_remove_file(&client->dev, &ads1000_attr.dev_attr);
return 0;
}
static int ads1000_probe
(struct i2c_client *client,
const struct i2c_device_id *id)
{
struct ads1000_platform_data *pdata = client->dev.platform_data;
int err = device_create_file(&client->dev, &ads1000_attr.dev_attr);
if (0 > err) {
dev_err(&client->dev, "%s: error %d creating %s
",
__func__, err, ads1000_attr.dev_attr.attr.name);
}
if ((0 == err) && (0 == pdata)) {
struct device_node *np = client->dev.of_node;
pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL);
pdata->numerator = 1;
pdata->denominator = 1;
client->dev.platform_data = pdata;
if (np) {
if (of_property_read_u32(np, "numerator",
&pdata->numerator)){
dev_err(&client->dev,
"%s: default to numerator == 1
",
__func__);
pdata->numerator = 1;
}
if (of_property_read_u32(np, "denominator",
&pdata->denominator)) {
dev_err(&client->dev,
"%s: default to denominator == 1
",
__func__);
pdata->denominator = 1;
}
} else
dev_err(&client->dev,
"%s: no device tree/no platform data
",
__func__);
}
return err;
}
static const struct i2c_device_id ads1000_id[] = {
{ "ads1000", 0 },
{}
};
MODULE_DEVICE_TABLE(i2c, ads1000_id);
static struct i2c_driver ads1000_driver = {
.driver = {
.name = "ads1000",
},
.probe = ads1000_probe,
.remove = ads1000_remove,
.id_table = ads1000_id,
};
static int __init ads1000_init(void)
{
return i2c_add_driver(&ads1000_driver);
}
static void __exit ads1000_exit(void)
{
i2c_del_driver(&ads1000_driver);
}
MODULE_AUTHOR("Eric Nelson <eric.nelson@boundarydevices.com>");
MODULE_DESCRIPTION("ADS1000 driver");
MODULE_LICENSE("GPL");
module_init(ads1000_init);
module_exit(ads1000_exit);
|