1
2
3
4
5
6
7
8
9
10#include <linux/kernel.h>
11#include <linux/module.h>
12#include <linux/moduleparam.h>
13#include <linux/device.h>
14#include <linux/types.h>
15#include <linux/delay.h>
16#ifdef CONFIG_W1_SLAVE_DS2433_CRC
17#include <linux/crc16.h>
18
19#define CRC16_INIT 0
20#define CRC16_VALID 0xb001
21
22#endif
23
24#include "../w1.h"
25#include "../w1_int.h"
26#include "../w1_family.h"
27
28MODULE_LICENSE("GPL");
29MODULE_AUTHOR("Ben Gardner <bgardner@wabtec.com>");
30MODULE_DESCRIPTION("w1 family 23 driver for DS2433, 4kb EEPROM");
31
32#define W1_EEPROM_SIZE 512
33#define W1_PAGE_COUNT 16
34#define W1_PAGE_SIZE 32
35#define W1_PAGE_BITS 5
36#define W1_PAGE_MASK 0x1F
37
38#define W1_F23_TIME 300
39
40#define W1_F23_READ_EEPROM 0xF0
41#define W1_F23_WRITE_SCRATCH 0x0F
42#define W1_F23_READ_SCRATCH 0xAA
43#define W1_F23_COPY_SCRATCH 0x55
44
45struct w1_f23_data {
46 u8 memory[W1_EEPROM_SIZE];
47 u32 validcrc;
48};
49
50
51
52
53
54static inline size_t w1_f23_fix_count(loff_t off, size_t count, size_t size)
55{
56 if (off > size)
57 return 0;
58
59 if ((off + count) > size)
60 return (size - off);
61
62 return count;
63}
64
65#ifdef CONFIG_W1_SLAVE_DS2433_CRC
66static int w1_f23_refresh_block(struct w1_slave *sl, struct w1_f23_data *data,
67 int block)
68{
69 u8 wrbuf[3];
70 int off = block * W1_PAGE_SIZE;
71
72 if (data->validcrc & (1 << block))
73 return 0;
74
75 if (w1_reset_select_slave(sl)) {
76 data->validcrc = 0;
77 return -EIO;
78 }
79
80 wrbuf[0] = W1_F23_READ_EEPROM;
81 wrbuf[1] = off & 0xff;
82 wrbuf[2] = off >> 8;
83 w1_write_block(sl->master, wrbuf, 3);
84 w1_read_block(sl->master, &data->memory[off], W1_PAGE_SIZE);
85
86
87 if (crc16(CRC16_INIT, &data->memory[off], W1_PAGE_SIZE) == CRC16_VALID)
88 data->validcrc |= (1 << block);
89
90 return 0;
91}
92#endif
93
94static ssize_t w1_f23_read_bin(struct kobject *kobj,
95 struct bin_attribute *bin_attr,
96 char *buf, loff_t off, size_t count)
97{
98 struct w1_slave *sl = kobj_to_w1_slave(kobj);
99#ifdef CONFIG_W1_SLAVE_DS2433_CRC
100 struct w1_f23_data *data = sl->family_data;
101 int i, min_page, max_page;
102#else
103 u8 wrbuf[3];
104#endif
105
106 if ((count = w1_f23_fix_count(off, count, W1_EEPROM_SIZE)) == 0)
107 return 0;
108
109 mutex_lock(&sl->master->mutex);
110
111#ifdef CONFIG_W1_SLAVE_DS2433_CRC
112
113 min_page = (off >> W1_PAGE_BITS);
114 max_page = (off + count - 1) >> W1_PAGE_BITS;
115 for (i = min_page; i <= max_page; i++) {
116 if (w1_f23_refresh_block(sl, data, i)) {
117 count = -EIO;
118 goto out_up;
119 }
120 }
121 memcpy(buf, &data->memory[off], count);
122
123#else
124
125
126 if (w1_reset_select_slave(sl)) {
127 count = -EIO;
128 goto out_up;
129 }
130
131 wrbuf[0] = W1_F23_READ_EEPROM;
132 wrbuf[1] = off & 0xff;
133 wrbuf[2] = off >> 8;
134 w1_write_block(sl->master, wrbuf, 3);
135 w1_read_block(sl->master, buf, count);
136
137#endif
138
139out_up:
140 mutex_unlock(&sl->master->mutex);
141
142 return count;
143}
144
145
146
147
148
149
150
151
152
153
154
155
156
157static int w1_f23_write(struct w1_slave *sl, int addr, int len, const u8 *data)
158{
159#ifdef CONFIG_W1_SLAVE_DS2433_CRC
160 struct w1_f23_data *f23 = sl->family_data;
161#endif
162 u8 wrbuf[4];
163 u8 rdbuf[W1_PAGE_SIZE + 3];
164 u8 es = (addr + len - 1) & 0x1f;
165
166
167 if (w1_reset_select_slave(sl))
168 return -1;
169
170 wrbuf[0] = W1_F23_WRITE_SCRATCH;
171 wrbuf[1] = addr & 0xff;
172 wrbuf[2] = addr >> 8;
173
174 w1_write_block(sl->master, wrbuf, 3);
175 w1_write_block(sl->master, data, len);
176
177
178 if (w1_reset_select_slave(sl))
179 return -1;
180
181 w1_write_8(sl->master, W1_F23_READ_SCRATCH);
182 w1_read_block(sl->master, rdbuf, len + 3);
183
184
185 if ((rdbuf[0] != wrbuf[1]) || (rdbuf[1] != wrbuf[2]) ||
186 (rdbuf[2] != es) || (memcmp(data, &rdbuf[3], len) != 0))
187 return -1;
188
189
190 if (w1_reset_select_slave(sl))
191 return -1;
192
193 wrbuf[0] = W1_F23_COPY_SCRATCH;
194 wrbuf[3] = es;
195 w1_write_block(sl->master, wrbuf, 4);
196
197
198 msleep(5);
199
200
201 w1_reset_bus(sl->master);
202#ifdef CONFIG_W1_SLAVE_DS2433_CRC
203 f23->validcrc &= ~(1 << (addr >> W1_PAGE_BITS));
204#endif
205 return 0;
206}
207
208static ssize_t w1_f23_write_bin(struct kobject *kobj,
209 struct bin_attribute *bin_attr,
210 char *buf, loff_t off, size_t count)
211{
212 struct w1_slave *sl = kobj_to_w1_slave(kobj);
213 int addr, len, idx;
214
215 if ((count = w1_f23_fix_count(off, count, W1_EEPROM_SIZE)) == 0)
216 return 0;
217
218#ifdef CONFIG_W1_SLAVE_DS2433_CRC
219
220 if ((off & W1_PAGE_MASK) || (count & W1_PAGE_MASK)) {
221 dev_err(&sl->dev, "invalid offset/count off=%d cnt=%zd\n",
222 (int)off, count);
223 return -EINVAL;
224 }
225
226
227 for (idx = 0; idx < count; idx += W1_PAGE_SIZE) {
228 if (crc16(CRC16_INIT, &buf[idx], W1_PAGE_SIZE) != CRC16_VALID) {
229 dev_err(&sl->dev, "bad CRC at offset %d\n", (int)off);
230 return -EINVAL;
231 }
232 }
233#endif
234
235 mutex_lock(&sl->master->mutex);
236
237
238 idx = 0;
239 while (idx < count) {
240 addr = off + idx;
241 len = W1_PAGE_SIZE - (addr & W1_PAGE_MASK);
242 if (len > (count - idx))
243 len = count - idx;
244
245 if (w1_f23_write(sl, addr, len, &buf[idx]) < 0) {
246 count = -EIO;
247 goto out_up;
248 }
249 idx += len;
250 }
251
252out_up:
253 mutex_unlock(&sl->master->mutex);
254
255 return count;
256}
257
258static struct bin_attribute w1_f23_bin_attr = {
259 .attr = {
260 .name = "eeprom",
261 .mode = S_IRUGO | S_IWUSR,
262 },
263 .size = W1_EEPROM_SIZE,
264 .read = w1_f23_read_bin,
265 .write = w1_f23_write_bin,
266};
267
268static int w1_f23_add_slave(struct w1_slave *sl)
269{
270 int err;
271#ifdef CONFIG_W1_SLAVE_DS2433_CRC
272 struct w1_f23_data *data;
273
274 data = kzalloc(sizeof(struct w1_f23_data), GFP_KERNEL);
275 if (!data)
276 return -ENOMEM;
277 sl->family_data = data;
278
279#endif
280
281 err = sysfs_create_bin_file(&sl->dev.kobj, &w1_f23_bin_attr);
282
283#ifdef CONFIG_W1_SLAVE_DS2433_CRC
284 if (err)
285 kfree(data);
286#endif
287
288 return err;
289}
290
291static void w1_f23_remove_slave(struct w1_slave *sl)
292{
293#ifdef CONFIG_W1_SLAVE_DS2433_CRC
294 kfree(sl->family_data);
295 sl->family_data = NULL;
296#endif
297 sysfs_remove_bin_file(&sl->dev.kobj, &w1_f23_bin_attr);
298}
299
300static struct w1_family_ops w1_f23_fops = {
301 .add_slave = w1_f23_add_slave,
302 .remove_slave = w1_f23_remove_slave,
303};
304
305static struct w1_family w1_family_23 = {
306 .fid = W1_EEPROM_DS2433,
307 .fops = &w1_f23_fops,
308};
309
310static int __init w1_f23_init(void)
311{
312 return w1_register_family(&w1_family_23);
313}
314
315static void __exit w1_f23_fini(void)
316{
317 w1_unregister_family(&w1_family_23);
318}
319
320module_init(w1_f23_init);
321module_exit(w1_f23_fini);
322