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#include <linux/kernel.h>
27#include <linux/module.h>
28#include <linux/slab.h>
29#include <linux/i2c.h>
30#include <linux/mutex.h>
31
32
33#define SLICE_SIZE 16
34#define SLICE_BITS 4
35
36
37#define USER_EEPROM_BASE 0x8100
38#define USER_EEPROM_SIZE 0x0200
39#define USER_EEPROM_SLICES 32
40
41
42#define MAX6875_CMD_BLK_READ 0x84
43
44
45struct max6875_data {
46 struct i2c_client *fake_client;
47 struct mutex update_lock;
48
49 u32 valid;
50 u8 data[USER_EEPROM_SIZE];
51 unsigned long last_updated[USER_EEPROM_SLICES];
52};
53
54static void max6875_update_slice(struct i2c_client *client, int slice)
55{
56 struct max6875_data *data = i2c_get_clientdata(client);
57 int i, j, addr;
58 u8 *buf;
59
60 if (slice >= USER_EEPROM_SLICES)
61 return;
62
63 mutex_lock(&data->update_lock);
64
65 buf = &data->data[slice << SLICE_BITS];
66
67 if (!(data->valid & (1 << slice)) ||
68 time_after(jiffies, data->last_updated[slice])) {
69
70 dev_dbg(&client->dev, "Starting update of slice %u\n", slice);
71
72 data->valid &= ~(1 << slice);
73
74 addr = USER_EEPROM_BASE + (slice << SLICE_BITS);
75
76
77 if (i2c_smbus_write_byte_data(client, addr >> 8, addr & 0xFF)) {
78 dev_err(&client->dev, "address set failed\n");
79 goto exit_up;
80 }
81
82 if (i2c_check_functionality(client->adapter,
83 I2C_FUNC_SMBUS_READ_I2C_BLOCK)) {
84 if (i2c_smbus_read_i2c_block_data(client,
85 MAX6875_CMD_BLK_READ,
86 SLICE_SIZE,
87 buf) != SLICE_SIZE) {
88 goto exit_up;
89 }
90 } else {
91 for (i = 0; i < SLICE_SIZE; i++) {
92 j = i2c_smbus_read_byte(client);
93 if (j < 0) {
94 goto exit_up;
95 }
96 buf[i] = j;
97 }
98 }
99 data->last_updated[slice] = jiffies;
100 data->valid |= (1 << slice);
101 }
102exit_up:
103 mutex_unlock(&data->update_lock);
104}
105
106static ssize_t max6875_read(struct file *filp, struct kobject *kobj,
107 struct bin_attribute *bin_attr,
108 char *buf, loff_t off, size_t count)
109{
110 struct i2c_client *client = kobj_to_i2c_client(kobj);
111 struct max6875_data *data = i2c_get_clientdata(client);
112 int slice, max_slice;
113
114
115 max_slice = (off + count - 1) >> SLICE_BITS;
116 for (slice = (off >> SLICE_BITS); slice <= max_slice; slice++)
117 max6875_update_slice(client, slice);
118
119 memcpy(buf, &data->data[off], count);
120
121 return count;
122}
123
124static const struct bin_attribute user_eeprom_attr = {
125 .attr = {
126 .name = "eeprom",
127 .mode = S_IRUGO,
128 },
129 .size = USER_EEPROM_SIZE,
130 .read = max6875_read,
131};
132
133static int max6875_probe(struct i2c_client *client,
134 const struct i2c_device_id *id)
135{
136 struct i2c_adapter *adapter = client->adapter;
137 struct max6875_data *data;
138 int err;
139
140 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WRITE_BYTE_DATA
141 | I2C_FUNC_SMBUS_READ_BYTE))
142 return -ENODEV;
143
144
145 if (client->addr & 1)
146 return -ENODEV;
147
148 data = kzalloc(sizeof(struct max6875_data), GFP_KERNEL);
149 if (!data)
150 return -ENOMEM;
151
152
153 data->fake_client = i2c_new_dummy_device(client->adapter, client->addr + 1);
154 if (IS_ERR(data->fake_client)) {
155 err = PTR_ERR(data->fake_client);
156 goto exit_kfree;
157 }
158
159
160 i2c_set_clientdata(client, data);
161 mutex_init(&data->update_lock);
162
163 err = sysfs_create_bin_file(&client->dev.kobj, &user_eeprom_attr);
164 if (err)
165 goto exit_remove_fake;
166
167 return 0;
168
169exit_remove_fake:
170 i2c_unregister_device(data->fake_client);
171exit_kfree:
172 kfree(data);
173 return err;
174}
175
176static int max6875_remove(struct i2c_client *client)
177{
178 struct max6875_data *data = i2c_get_clientdata(client);
179
180 i2c_unregister_device(data->fake_client);
181
182 sysfs_remove_bin_file(&client->dev.kobj, &user_eeprom_attr);
183 kfree(data);
184
185 return 0;
186}
187
188static const struct i2c_device_id max6875_id[] = {
189 { "max6875", 0 },
190 { }
191};
192MODULE_DEVICE_TABLE(i2c, max6875_id);
193
194static struct i2c_driver max6875_driver = {
195 .driver = {
196 .name = "max6875",
197 },
198 .probe = max6875_probe,
199 .remove = max6875_remove,
200 .id_table = max6875_id,
201};
202
203module_i2c_driver(max6875_driver);
204
205MODULE_AUTHOR("Ben Gardner <bgardner@wabtec.com>");
206MODULE_DESCRIPTION("MAX6875 driver");
207MODULE_LICENSE("GPL");
208