1
2
3
4
5
6
7
8
9
10
11
12#include <linux/kernel.h>
13#include <linux/init.h>
14#include <linux/module.h>
15#include <linux/slab.h>
16#include <linux/delay.h>
17#include <linux/mutex.h>
18#include <linux/mod_devicetable.h>
19#include <linux/log2.h>
20#include <linux/bitops.h>
21#include <linux/jiffies.h>
22#include <linux/of.h>
23#include <linux/acpi.h>
24#include <linux/i2c.h>
25#include <linux/nvmem-provider.h>
26#include <linux/regmap.h>
27#include <linux/platform_data/at24.h>
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
57struct at24_data {
58 struct at24_platform_data chip;
59 int use_smbus;
60 int use_smbus_write;
61
62
63
64
65
66 struct mutex lock;
67
68 u8 *writebuf;
69 unsigned write_max;
70 unsigned num_addresses;
71
72 struct regmap_config regmap_config;
73 struct nvmem_config nvmem_config;
74 struct nvmem_device *nvmem;
75
76
77
78
79
80 struct i2c_client *client[];
81};
82
83
84
85
86
87
88
89
90
91
92static unsigned io_limit = 128;
93module_param(io_limit, uint, 0);
94MODULE_PARM_DESC(io_limit, "Maximum bytes per I/O (default 128)");
95
96
97
98
99
100static unsigned write_timeout = 25;
101module_param(write_timeout, uint, 0);
102MODULE_PARM_DESC(write_timeout, "Time (in ms) to try writes (default 25)");
103
104#define AT24_SIZE_BYTELEN 5
105#define AT24_SIZE_FLAGS 8
106
107#define AT24_BITMASK(x) (BIT(x) - 1)
108
109
110#define AT24_DEVICE_MAGIC(_len, _flags) \
111 ((1 << AT24_SIZE_FLAGS | (_flags)) \
112 << AT24_SIZE_BYTELEN | ilog2(_len))
113
114static const struct i2c_device_id at24_ids[] = {
115
116 { "24c00", AT24_DEVICE_MAGIC(128 / 8, AT24_FLAG_TAKE8ADDR) },
117
118 { "24c01", AT24_DEVICE_MAGIC(1024 / 8, 0) },
119 { "24c02", AT24_DEVICE_MAGIC(2048 / 8, 0) },
120
121 { "spd", AT24_DEVICE_MAGIC(2048 / 8,
122 AT24_FLAG_READONLY | AT24_FLAG_IRUGO) },
123 { "24c04", AT24_DEVICE_MAGIC(4096 / 8, 0) },
124
125 { "24c08", AT24_DEVICE_MAGIC(8192 / 8, 0) },
126 { "24c16", AT24_DEVICE_MAGIC(16384 / 8, 0) },
127 { "24c32", AT24_DEVICE_MAGIC(32768 / 8, AT24_FLAG_ADDR16) },
128 { "24c64", AT24_DEVICE_MAGIC(65536 / 8, AT24_FLAG_ADDR16) },
129 { "24c128", AT24_DEVICE_MAGIC(131072 / 8, AT24_FLAG_ADDR16) },
130 { "24c256", AT24_DEVICE_MAGIC(262144 / 8, AT24_FLAG_ADDR16) },
131 { "24c512", AT24_DEVICE_MAGIC(524288 / 8, AT24_FLAG_ADDR16) },
132 { "24c1024", AT24_DEVICE_MAGIC(1048576 / 8, AT24_FLAG_ADDR16) },
133 { "at24", 0 },
134 { }
135};
136MODULE_DEVICE_TABLE(i2c, at24_ids);
137
138static const struct acpi_device_id at24_acpi_ids[] = {
139 { "INT3499", AT24_DEVICE_MAGIC(8192 / 8, 0) },
140 { }
141};
142MODULE_DEVICE_TABLE(acpi, at24_acpi_ids);
143
144
145
146
147
148
149
150
151static struct i2c_client *at24_translate_offset(struct at24_data *at24,
152 unsigned *offset)
153{
154 unsigned i;
155
156 if (at24->chip.flags & AT24_FLAG_ADDR16) {
157 i = *offset >> 16;
158 *offset &= 0xffff;
159 } else {
160 i = *offset >> 8;
161 *offset &= 0xff;
162 }
163
164 return at24->client[i];
165}
166
167static ssize_t at24_eeprom_read(struct at24_data *at24, char *buf,
168 unsigned offset, size_t count)
169{
170 struct i2c_msg msg[2];
171 u8 msgbuf[2];
172 struct i2c_client *client;
173 unsigned long timeout, read_time;
174 int status, i;
175
176 memset(msg, 0, sizeof(msg));
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194 client = at24_translate_offset(at24, &offset);
195
196 if (count > io_limit)
197 count = io_limit;
198
199 if (at24->use_smbus) {
200
201 if (count > I2C_SMBUS_BLOCK_MAX)
202 count = I2C_SMBUS_BLOCK_MAX;
203 } else {
204
205
206
207
208
209
210
211 i = 0;
212 if (at24->chip.flags & AT24_FLAG_ADDR16)
213 msgbuf[i++] = offset >> 8;
214 msgbuf[i++] = offset;
215
216 msg[0].addr = client->addr;
217 msg[0].buf = msgbuf;
218 msg[0].len = i;
219
220 msg[1].addr = client->addr;
221 msg[1].flags = I2C_M_RD;
222 msg[1].buf = buf;
223 msg[1].len = count;
224 }
225
226
227
228
229
230
231 timeout = jiffies + msecs_to_jiffies(write_timeout);
232 do {
233 read_time = jiffies;
234 if (at24->use_smbus) {
235 status = i2c_smbus_read_i2c_block_data_or_emulated(client, offset,
236 count, buf);
237 } else {
238 status = i2c_transfer(client->adapter, msg, 2);
239 if (status == 2)
240 status = count;
241 }
242 dev_dbg(&client->dev, "read %zu@%d --> %d (%ld)\n",
243 count, offset, status, jiffies);
244
245 if (status == count)
246 return count;
247
248
249 msleep(1);
250 } while (time_before(read_time, timeout));
251
252 return -ETIMEDOUT;
253}
254
255static ssize_t at24_read(struct at24_data *at24,
256 char *buf, loff_t off, size_t count)
257{
258 ssize_t retval = 0;
259
260 if (unlikely(!count))
261 return count;
262
263
264
265
266
267 mutex_lock(&at24->lock);
268
269 while (count) {
270 ssize_t status;
271
272 status = at24_eeprom_read(at24, buf, off, count);
273 if (status <= 0) {
274 if (retval == 0)
275 retval = status;
276 break;
277 }
278 buf += status;
279 off += status;
280 count -= status;
281 retval += status;
282 }
283
284 mutex_unlock(&at24->lock);
285
286 return retval;
287}
288
289
290
291
292
293
294
295
296
297static ssize_t at24_eeprom_write(struct at24_data *at24, const char *buf,
298 unsigned offset, size_t count)
299{
300 struct i2c_client *client;
301 struct i2c_msg msg;
302 ssize_t status = 0;
303 unsigned long timeout, write_time;
304 unsigned next_page;
305
306
307 client = at24_translate_offset(at24, &offset);
308
309
310 if (count > at24->write_max)
311 count = at24->write_max;
312
313
314 next_page = roundup(offset + 1, at24->chip.page_size);
315 if (offset + count > next_page)
316 count = next_page - offset;
317
318
319 if (!at24->use_smbus) {
320 int i = 0;
321
322 msg.addr = client->addr;
323 msg.flags = 0;
324
325
326 msg.buf = at24->writebuf;
327 if (at24->chip.flags & AT24_FLAG_ADDR16)
328 msg.buf[i++] = offset >> 8;
329
330 msg.buf[i++] = offset;
331 memcpy(&msg.buf[i], buf, count);
332 msg.len = i + count;
333 }
334
335
336
337
338
339
340 timeout = jiffies + msecs_to_jiffies(write_timeout);
341 do {
342 write_time = jiffies;
343 if (at24->use_smbus_write) {
344 switch (at24->use_smbus_write) {
345 case I2C_SMBUS_I2C_BLOCK_DATA:
346 status = i2c_smbus_write_i2c_block_data(client,
347 offset, count, buf);
348 break;
349 case I2C_SMBUS_BYTE_DATA:
350 status = i2c_smbus_write_byte_data(client,
351 offset, buf[0]);
352 break;
353 }
354
355 if (status == 0)
356 status = count;
357 } else {
358 status = i2c_transfer(client->adapter, &msg, 1);
359 if (status == 1)
360 status = count;
361 }
362 dev_dbg(&client->dev, "write %zu@%d --> %zd (%ld)\n",
363 count, offset, status, jiffies);
364
365 if (status == count)
366 return count;
367
368
369 msleep(1);
370 } while (time_before(write_time, timeout));
371
372 return -ETIMEDOUT;
373}
374
375static ssize_t at24_write(struct at24_data *at24, const char *buf, loff_t off,
376 size_t count)
377{
378 ssize_t retval = 0;
379
380 if (unlikely(!count))
381 return count;
382
383
384
385
386
387 mutex_lock(&at24->lock);
388
389 while (count) {
390 ssize_t status;
391
392 status = at24_eeprom_write(at24, buf, off, count);
393 if (status <= 0) {
394 if (retval == 0)
395 retval = status;
396 break;
397 }
398 buf += status;
399 off += status;
400 count -= status;
401 retval += status;
402 }
403
404 mutex_unlock(&at24->lock);
405
406 return retval;
407}
408
409
410
411
412
413
414
415static int at24_regmap_read(void *context, const void *reg, size_t reg_size,
416 void *val, size_t val_size)
417{
418 struct at24_data *at24 = context;
419 off_t offset = *(u32 *)reg;
420 int err;
421
422 err = at24_read(at24, val, offset, val_size);
423 if (err)
424 return err;
425 return 0;
426}
427
428static int at24_regmap_write(void *context, const void *data, size_t count)
429{
430 struct at24_data *at24 = context;
431 const char *buf;
432 u32 offset;
433 size_t len;
434 int err;
435
436 memcpy(&offset, data, sizeof(offset));
437 buf = (const char *)data + sizeof(offset);
438 len = count - sizeof(offset);
439
440 err = at24_write(at24, buf, offset, len);
441 if (err)
442 return err;
443 return 0;
444}
445
446static const struct regmap_bus at24_regmap_bus = {
447 .read = at24_regmap_read,
448 .write = at24_regmap_write,
449 .reg_format_endian_default = REGMAP_ENDIAN_NATIVE,
450};
451
452
453
454#ifdef CONFIG_OF
455static void at24_get_ofdata(struct i2c_client *client,
456 struct at24_platform_data *chip)
457{
458 const __be32 *val;
459 struct device_node *node = client->dev.of_node;
460
461 if (node) {
462 if (of_get_property(node, "read-only", NULL))
463 chip->flags |= AT24_FLAG_READONLY;
464 val = of_get_property(node, "pagesize", NULL);
465 if (val)
466 chip->page_size = be32_to_cpup(val);
467 }
468}
469#else
470static void at24_get_ofdata(struct i2c_client *client,
471 struct at24_platform_data *chip)
472{ }
473#endif
474
475static int at24_probe(struct i2c_client *client, const struct i2c_device_id *id)
476{
477 struct at24_platform_data chip;
478 kernel_ulong_t magic = 0;
479 bool writable;
480 int use_smbus = 0;
481 int use_smbus_write = 0;
482 struct at24_data *at24;
483 int err;
484 unsigned i, num_addresses;
485 struct regmap *regmap;
486
487 if (client->dev.platform_data) {
488 chip = *(struct at24_platform_data *)client->dev.platform_data;
489 } else {
490 if (id) {
491 magic = id->driver_data;
492 } else {
493 const struct acpi_device_id *aid;
494
495 aid = acpi_match_device(at24_acpi_ids, &client->dev);
496 if (aid)
497 magic = aid->driver_data;
498 }
499 if (!magic)
500 return -ENODEV;
501
502 chip.byte_len = BIT(magic & AT24_BITMASK(AT24_SIZE_BYTELEN));
503 magic >>= AT24_SIZE_BYTELEN;
504 chip.flags = magic & AT24_BITMASK(AT24_SIZE_FLAGS);
505
506
507
508
509
510 chip.page_size = 1;
511
512
513 at24_get_ofdata(client, &chip);
514
515 chip.setup = NULL;
516 chip.context = NULL;
517 }
518
519 if (!is_power_of_2(chip.byte_len))
520 dev_warn(&client->dev,
521 "byte_len looks suspicious (no power of 2)!\n");
522 if (!chip.page_size) {
523 dev_err(&client->dev, "page_size must not be 0!\n");
524 return -EINVAL;
525 }
526 if (!is_power_of_2(chip.page_size))
527 dev_warn(&client->dev,
528 "page_size looks suspicious (no power of 2)!\n");
529
530
531 if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
532 if (chip.flags & AT24_FLAG_ADDR16)
533 return -EPFNOSUPPORT;
534
535 if (i2c_check_functionality(client->adapter,
536 I2C_FUNC_SMBUS_READ_I2C_BLOCK)) {
537 use_smbus = I2C_SMBUS_I2C_BLOCK_DATA;
538 } else if (i2c_check_functionality(client->adapter,
539 I2C_FUNC_SMBUS_READ_WORD_DATA)) {
540 use_smbus = I2C_SMBUS_WORD_DATA;
541 } else if (i2c_check_functionality(client->adapter,
542 I2C_FUNC_SMBUS_READ_BYTE_DATA)) {
543 use_smbus = I2C_SMBUS_BYTE_DATA;
544 } else {
545 return -EPFNOSUPPORT;
546 }
547 }
548
549
550 if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
551 if (i2c_check_functionality(client->adapter,
552 I2C_FUNC_SMBUS_WRITE_I2C_BLOCK)) {
553 use_smbus_write = I2C_SMBUS_I2C_BLOCK_DATA;
554 } else if (i2c_check_functionality(client->adapter,
555 I2C_FUNC_SMBUS_WRITE_BYTE_DATA)) {
556 use_smbus_write = I2C_SMBUS_BYTE_DATA;
557 chip.page_size = 1;
558 }
559 }
560
561 if (chip.flags & AT24_FLAG_TAKE8ADDR)
562 num_addresses = 8;
563 else
564 num_addresses = DIV_ROUND_UP(chip.byte_len,
565 (chip.flags & AT24_FLAG_ADDR16) ? 65536 : 256);
566
567 at24 = devm_kzalloc(&client->dev, sizeof(struct at24_data) +
568 num_addresses * sizeof(struct i2c_client *), GFP_KERNEL);
569 if (!at24)
570 return -ENOMEM;
571
572 mutex_init(&at24->lock);
573 at24->use_smbus = use_smbus;
574 at24->use_smbus_write = use_smbus_write;
575 at24->chip = chip;
576 at24->num_addresses = num_addresses;
577
578 writable = !(chip.flags & AT24_FLAG_READONLY);
579 if (writable) {
580 if (!use_smbus || use_smbus_write) {
581
582 unsigned write_max = chip.page_size;
583
584 if (write_max > io_limit)
585 write_max = io_limit;
586 if (use_smbus && write_max > I2C_SMBUS_BLOCK_MAX)
587 write_max = I2C_SMBUS_BLOCK_MAX;
588 at24->write_max = write_max;
589
590
591 at24->writebuf = devm_kzalloc(&client->dev,
592 write_max + 2, GFP_KERNEL);
593 if (!at24->writebuf)
594 return -ENOMEM;
595 } else {
596 dev_warn(&client->dev,
597 "cannot write due to controller restrictions.");
598 }
599 }
600
601 at24->client[0] = client;
602
603
604 for (i = 1; i < num_addresses; i++) {
605 at24->client[i] = i2c_new_dummy(client->adapter,
606 client->addr + i);
607 if (!at24->client[i]) {
608 dev_err(&client->dev, "address 0x%02x unavailable\n",
609 client->addr + i);
610 err = -EADDRINUSE;
611 goto err_clients;
612 }
613 }
614
615 at24->regmap_config.reg_bits = 32;
616 at24->regmap_config.val_bits = 8;
617 at24->regmap_config.reg_stride = 1;
618 at24->regmap_config.max_register = chip.byte_len - 1;
619
620 regmap = devm_regmap_init(&client->dev, &at24_regmap_bus, at24,
621 &at24->regmap_config);
622 if (IS_ERR(regmap)) {
623 dev_err(&client->dev, "regmap init failed\n");
624 err = PTR_ERR(regmap);
625 goto err_clients;
626 }
627
628 at24->nvmem_config.name = dev_name(&client->dev);
629 at24->nvmem_config.dev = &client->dev;
630 at24->nvmem_config.read_only = !writable;
631 at24->nvmem_config.root_only = true;
632 at24->nvmem_config.owner = THIS_MODULE;
633 at24->nvmem_config.compat = true;
634 at24->nvmem_config.base_dev = &client->dev;
635
636 at24->nvmem = nvmem_register(&at24->nvmem_config);
637
638 if (IS_ERR(at24->nvmem)) {
639 err = PTR_ERR(at24->nvmem);
640 goto err_clients;
641 }
642
643 i2c_set_clientdata(client, at24);
644
645 dev_info(&client->dev, "%u byte %s EEPROM, %s, %u bytes/write\n",
646 chip.byte_len, client->name,
647 writable ? "writable" : "read-only", at24->write_max);
648 if (use_smbus == I2C_SMBUS_WORD_DATA ||
649 use_smbus == I2C_SMBUS_BYTE_DATA) {
650 dev_notice(&client->dev, "Falling back to %s reads, "
651 "performance will suffer\n", use_smbus ==
652 I2C_SMBUS_WORD_DATA ? "word" : "byte");
653 }
654
655
656 if (chip.setup)
657 chip.setup(at24->nvmem, chip.context);
658
659 return 0;
660
661err_clients:
662 for (i = 1; i < num_addresses; i++)
663 if (at24->client[i])
664 i2c_unregister_device(at24->client[i]);
665
666 return err;
667}
668
669static int at24_remove(struct i2c_client *client)
670{
671 struct at24_data *at24;
672 int i;
673
674 at24 = i2c_get_clientdata(client);
675
676 nvmem_unregister(at24->nvmem);
677
678 for (i = 1; i < at24->num_addresses; i++)
679 i2c_unregister_device(at24->client[i]);
680
681 return 0;
682}
683
684
685
686static struct i2c_driver at24_driver = {
687 .driver = {
688 .name = "at24",
689 .acpi_match_table = ACPI_PTR(at24_acpi_ids),
690 },
691 .probe = at24_probe,
692 .remove = at24_remove,
693 .id_table = at24_ids,
694};
695
696static int __init at24_init(void)
697{
698 if (!io_limit) {
699 pr_err("at24: io_limit must not be 0!\n");
700 return -EINVAL;
701 }
702
703 io_limit = rounddown_pow_of_two(io_limit);
704 return i2c_add_driver(&at24_driver);
705}
706module_init(at24_init);
707
708static void __exit at24_exit(void)
709{
710 i2c_del_driver(&at24_driver);
711}
712module_exit(at24_exit);
713
714MODULE_DESCRIPTION("Driver for most I2C EEPROMs");
715MODULE_AUTHOR("David Brownell and Wolfram Sang");
716MODULE_LICENSE("GPL");
717