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