1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18#include <linux/i2c.h>
19#include <linux/module.h>
20#include <linux/wait.h>
21#include "tpm.h"
22
23#define TPM_I2C_INFINEON_BUFSIZE 1260
24
25
26#define MAX_COUNT 3
27
28#define SLEEP_DURATION_LOW 55
29#define SLEEP_DURATION_HI 65
30
31
32
33
34
35
36#define MAX_COUNT_LONG 50
37
38#define SLEEP_DURATION_LONG_LOW 200
39#define SLEEP_DURATION_LONG_HI 220
40
41
42#define SLEEP_DURATION_RESET_LOW 2400
43#define SLEEP_DURATION_RESET_HI 2600
44
45
46#define TPM_TIMEOUT_US_LOW (TPM_TIMEOUT * 1000)
47#define TPM_TIMEOUT_US_HI (TPM_TIMEOUT_US_LOW + 2000)
48
49
50#define TPM_TIS_I2C_DID_VID_9635 0xd1150b00L
51#define TPM_TIS_I2C_DID_VID_9645 0x001a15d1L
52
53enum i2c_chip_type {
54 SLB9635,
55 SLB9645,
56 UNKNOWN,
57};
58
59struct tpm_inf_dev {
60 struct i2c_client *client;
61 int locality;
62
63
64
65 u8 buf[TPM_I2C_INFINEON_BUFSIZE + 1];
66 struct tpm_chip *chip;
67 enum i2c_chip_type chip_type;
68 unsigned int adapterlimit;
69};
70
71static struct tpm_inf_dev tpm_dev;
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92static int iic_tpm_read(u8 addr, u8 *buffer, size_t len)
93{
94
95 struct i2c_msg msg1 = {
96 .addr = tpm_dev.client->addr,
97 .len = 1,
98 .buf = &addr
99 };
100 struct i2c_msg msg2 = {
101 .addr = tpm_dev.client->addr,
102 .flags = I2C_M_RD,
103 .len = len,
104 .buf = buffer
105 };
106 struct i2c_msg msgs[] = {msg1, msg2};
107
108 int rc = 0;
109 int count;
110 unsigned int msglen = len;
111
112
113 if (!tpm_dev.client->adapter->algo->master_xfer)
114 return -EOPNOTSUPP;
115 i2c_lock_bus(tpm_dev.client->adapter, I2C_LOCK_SEGMENT);
116
117 if (tpm_dev.chip_type == SLB9645) {
118
119
120
121
122
123
124 for (count = 0; count < MAX_COUNT; count++) {
125 rc = __i2c_transfer(tpm_dev.client->adapter, msgs, 2);
126 if (rc > 0)
127 break;
128 usleep_range(SLEEP_DURATION_LOW, SLEEP_DURATION_HI);
129 }
130 } else {
131
132
133
134 while (len > 0) {
135
136 for (count = 0; count < MAX_COUNT; count++) {
137 rc = __i2c_transfer(tpm_dev.client->adapter,
138 &msg1, 1);
139 if (rc > 0)
140 break;
141
142 usleep_range(SLEEP_DURATION_LOW,
143 SLEEP_DURATION_HI);
144 }
145
146 if (rc <= 0)
147 goto out;
148
149
150
151
152
153 for (count = 0; count < MAX_COUNT; count++) {
154 if (tpm_dev.adapterlimit) {
155 msglen = min_t(unsigned int,
156 tpm_dev.adapterlimit,
157 len);
158 msg2.len = msglen;
159 }
160 usleep_range(SLEEP_DURATION_LOW,
161 SLEEP_DURATION_HI);
162 rc = __i2c_transfer(tpm_dev.client->adapter,
163 &msg2, 1);
164 if (rc > 0) {
165
166
167
168 if (msglen > len)
169 len = 0;
170 else
171 len -= msglen;
172 msg2.buf += msglen;
173 break;
174 }
175
176
177
178
179 if (rc == -EOPNOTSUPP)
180 tpm_dev.adapterlimit =
181 I2C_SMBUS_BLOCK_MAX;
182 }
183
184 if (rc <= 0)
185 goto out;
186 }
187 }
188
189out:
190 i2c_unlock_bus(tpm_dev.client->adapter, I2C_LOCK_SEGMENT);
191
192 usleep_range(SLEEP_DURATION_LOW, SLEEP_DURATION_HI);
193
194
195
196
197
198 if (rc <= 0)
199 return -EIO;
200
201 return 0;
202}
203
204static int iic_tpm_write_generic(u8 addr, u8 *buffer, size_t len,
205 unsigned int sleep_low,
206 unsigned int sleep_hi, u8 max_count)
207{
208 int rc = -EIO;
209 int count;
210
211 struct i2c_msg msg1 = {
212 .addr = tpm_dev.client->addr,
213 .len = len + 1,
214 .buf = tpm_dev.buf
215 };
216
217 if (len > TPM_I2C_INFINEON_BUFSIZE)
218 return -EINVAL;
219
220 if (!tpm_dev.client->adapter->algo->master_xfer)
221 return -EOPNOTSUPP;
222 i2c_lock_bus(tpm_dev.client->adapter, I2C_LOCK_SEGMENT);
223
224
225 tpm_dev.buf[0] = addr;
226 memcpy(&(tpm_dev.buf[1]), buffer, len);
227
228
229
230
231
232
233
234 for (count = 0; count < max_count; count++) {
235 rc = __i2c_transfer(tpm_dev.client->adapter, &msg1, 1);
236 if (rc > 0)
237 break;
238 usleep_range(sleep_low, sleep_hi);
239 }
240
241 i2c_unlock_bus(tpm_dev.client->adapter, I2C_LOCK_SEGMENT);
242
243 usleep_range(SLEEP_DURATION_LOW, SLEEP_DURATION_HI);
244
245
246
247
248
249 if (rc <= 0)
250 return -EIO;
251
252 return 0;
253}
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271static int iic_tpm_write(u8 addr, u8 *buffer, size_t len)
272{
273 return iic_tpm_write_generic(addr, buffer, len, SLEEP_DURATION_LOW,
274 SLEEP_DURATION_HI, MAX_COUNT);
275}
276
277
278
279
280
281static int iic_tpm_write_long(u8 addr, u8 *buffer, size_t len)
282{
283 return iic_tpm_write_generic(addr, buffer, len, SLEEP_DURATION_LONG_LOW,
284 SLEEP_DURATION_LONG_HI, MAX_COUNT_LONG);
285}
286
287enum tis_access {
288 TPM_ACCESS_VALID = 0x80,
289 TPM_ACCESS_ACTIVE_LOCALITY = 0x20,
290 TPM_ACCESS_REQUEST_PENDING = 0x04,
291 TPM_ACCESS_REQUEST_USE = 0x02,
292};
293
294enum tis_status {
295 TPM_STS_VALID = 0x80,
296 TPM_STS_COMMAND_READY = 0x40,
297 TPM_STS_GO = 0x20,
298 TPM_STS_DATA_AVAIL = 0x10,
299 TPM_STS_DATA_EXPECT = 0x08,
300};
301
302enum tis_defaults {
303 TIS_SHORT_TIMEOUT = 750,
304 TIS_LONG_TIMEOUT = 2000,
305};
306
307#define TPM_ACCESS(l) (0x0000 | ((l) << 4))
308#define TPM_STS(l) (0x0001 | ((l) << 4))
309#define TPM_DATA_FIFO(l) (0x0005 | ((l) << 4))
310#define TPM_DID_VID(l) (0x0006 | ((l) << 4))
311
312static bool check_locality(struct tpm_chip *chip, int loc)
313{
314 u8 buf;
315 int rc;
316
317 rc = iic_tpm_read(TPM_ACCESS(loc), &buf, 1);
318 if (rc < 0)
319 return false;
320
321 if ((buf & (TPM_ACCESS_ACTIVE_LOCALITY | TPM_ACCESS_VALID)) ==
322 (TPM_ACCESS_ACTIVE_LOCALITY | TPM_ACCESS_VALID)) {
323 tpm_dev.locality = loc;
324 return true;
325 }
326
327 return false;
328}
329
330
331static void release_locality(struct tpm_chip *chip, int loc, int force)
332{
333 u8 buf;
334 if (iic_tpm_read(TPM_ACCESS(loc), &buf, 1) < 0)
335 return;
336
337 if (force || (buf & (TPM_ACCESS_REQUEST_PENDING | TPM_ACCESS_VALID)) ==
338 (TPM_ACCESS_REQUEST_PENDING | TPM_ACCESS_VALID)) {
339 buf = TPM_ACCESS_ACTIVE_LOCALITY;
340 iic_tpm_write(TPM_ACCESS(loc), &buf, 1);
341 }
342}
343
344static int request_locality(struct tpm_chip *chip, int loc)
345{
346 unsigned long stop;
347 u8 buf = TPM_ACCESS_REQUEST_USE;
348
349 if (check_locality(chip, loc))
350 return loc;
351
352 iic_tpm_write(TPM_ACCESS(loc), &buf, 1);
353
354
355 stop = jiffies + chip->timeout_a;
356 do {
357 if (check_locality(chip, loc))
358 return loc;
359 usleep_range(TPM_TIMEOUT_US_LOW, TPM_TIMEOUT_US_HI);
360 } while (time_before(jiffies, stop));
361
362 return -ETIME;
363}
364
365static u8 tpm_tis_i2c_status(struct tpm_chip *chip)
366{
367
368 u8 buf = 0xFF;
369 u8 i = 0;
370
371 do {
372 if (iic_tpm_read(TPM_STS(tpm_dev.locality), &buf, 1) < 0)
373 return 0;
374
375 i++;
376
377 } while ((buf == 0xFF) && i < 10);
378
379 return buf;
380}
381
382static void tpm_tis_i2c_ready(struct tpm_chip *chip)
383{
384
385 u8 buf = TPM_STS_COMMAND_READY;
386 iic_tpm_write_long(TPM_STS(tpm_dev.locality), &buf, 1);
387}
388
389static ssize_t get_burstcount(struct tpm_chip *chip)
390{
391 unsigned long stop;
392 ssize_t burstcnt;
393 u8 buf[3];
394
395
396
397 stop = jiffies + chip->timeout_d;
398 do {
399
400 if (iic_tpm_read(TPM_STS(tpm_dev.locality)+1, buf, 3) < 0)
401 burstcnt = 0;
402 else
403 burstcnt = (buf[2] << 16) + (buf[1] << 8) + buf[0];
404
405 if (burstcnt)
406 return burstcnt;
407
408 usleep_range(TPM_TIMEOUT_US_LOW, TPM_TIMEOUT_US_HI);
409 } while (time_before(jiffies, stop));
410 return -EBUSY;
411}
412
413static int wait_for_stat(struct tpm_chip *chip, u8 mask, unsigned long timeout,
414 int *status)
415{
416 unsigned long stop;
417
418
419 *status = tpm_tis_i2c_status(chip);
420 if ((*status != 0xFF) && (*status & mask) == mask)
421 return 0;
422
423 stop = jiffies + timeout;
424 do {
425
426 usleep_range(TPM_TIMEOUT_US_LOW, TPM_TIMEOUT_US_HI);
427 *status = tpm_tis_i2c_status(chip);
428 if ((*status & mask) == mask)
429 return 0;
430
431 } while (time_before(jiffies, stop));
432
433 return -ETIME;
434}
435
436static int recv_data(struct tpm_chip *chip, u8 *buf, size_t count)
437{
438 size_t size = 0;
439 ssize_t burstcnt;
440 u8 retries = 0;
441 int rc;
442
443 while (size < count) {
444 burstcnt = get_burstcount(chip);
445
446
447 if (burstcnt < 0)
448 return burstcnt;
449
450
451 if (burstcnt > (count - size))
452 burstcnt = count - size;
453
454 rc = iic_tpm_read(TPM_DATA_FIFO(tpm_dev.locality),
455 &(buf[size]), burstcnt);
456 if (rc == 0)
457 size += burstcnt;
458 else if (rc < 0)
459 retries++;
460
461
462 if (retries > MAX_COUNT_LONG)
463 return -EIO;
464 }
465 return size;
466}
467
468static int tpm_tis_i2c_recv(struct tpm_chip *chip, u8 *buf, size_t count)
469{
470 int size = 0;
471 int status;
472 u32 expected;
473
474 if (count < TPM_HEADER_SIZE) {
475 size = -EIO;
476 goto out;
477 }
478
479
480 size = recv_data(chip, buf, TPM_HEADER_SIZE);
481 if (size < TPM_HEADER_SIZE) {
482 dev_err(&chip->dev, "Unable to read header\n");
483 goto out;
484 }
485
486 expected = be32_to_cpu(*(__be32 *)(buf + 2));
487 if (((size_t) expected > count) || (expected < TPM_HEADER_SIZE)) {
488 size = -EIO;
489 goto out;
490 }
491
492 size += recv_data(chip, &buf[TPM_HEADER_SIZE],
493 expected - TPM_HEADER_SIZE);
494 if (size < expected) {
495 dev_err(&chip->dev, "Unable to read remainder of result\n");
496 size = -ETIME;
497 goto out;
498 }
499
500 wait_for_stat(chip, TPM_STS_VALID, chip->timeout_c, &status);
501 if (status & TPM_STS_DATA_AVAIL) {
502 dev_err(&chip->dev, "Error left over data\n");
503 size = -EIO;
504 goto out;
505 }
506
507out:
508 tpm_tis_i2c_ready(chip);
509
510
511
512 usleep_range(SLEEP_DURATION_RESET_LOW, SLEEP_DURATION_RESET_HI);
513 release_locality(chip, tpm_dev.locality, 0);
514 return size;
515}
516
517static int tpm_tis_i2c_send(struct tpm_chip *chip, u8 *buf, size_t len)
518{
519 int rc, status;
520 ssize_t burstcnt;
521 size_t count = 0;
522 u8 retries = 0;
523 u8 sts = TPM_STS_GO;
524
525 if (len > TPM_I2C_INFINEON_BUFSIZE)
526 return -E2BIG;
527
528 if (request_locality(chip, 0) < 0)
529 return -EBUSY;
530
531 status = tpm_tis_i2c_status(chip);
532 if ((status & TPM_STS_COMMAND_READY) == 0) {
533 tpm_tis_i2c_ready(chip);
534 if (wait_for_stat
535 (chip, TPM_STS_COMMAND_READY,
536 chip->timeout_b, &status) < 0) {
537 rc = -ETIME;
538 goto out_err;
539 }
540 }
541
542 while (count < len - 1) {
543 burstcnt = get_burstcount(chip);
544
545
546 if (burstcnt < 0)
547 return burstcnt;
548
549 if (burstcnt > (len - 1 - count))
550 burstcnt = len - 1 - count;
551
552 rc = iic_tpm_write(TPM_DATA_FIFO(tpm_dev.locality),
553 &(buf[count]), burstcnt);
554 if (rc == 0)
555 count += burstcnt;
556 else if (rc < 0)
557 retries++;
558
559
560 if (retries > MAX_COUNT_LONG) {
561 rc = -EIO;
562 goto out_err;
563 }
564
565 wait_for_stat(chip, TPM_STS_VALID,
566 chip->timeout_c, &status);
567
568 if ((status & TPM_STS_DATA_EXPECT) == 0) {
569 rc = -EIO;
570 goto out_err;
571 }
572 }
573
574
575 iic_tpm_write(TPM_DATA_FIFO(tpm_dev.locality), &(buf[count]), 1);
576 wait_for_stat(chip, TPM_STS_VALID, chip->timeout_c, &status);
577 if ((status & TPM_STS_DATA_EXPECT) != 0) {
578 rc = -EIO;
579 goto out_err;
580 }
581
582
583 iic_tpm_write(TPM_STS(tpm_dev.locality), &sts, 1);
584
585 return 0;
586out_err:
587 tpm_tis_i2c_ready(chip);
588
589
590
591 usleep_range(SLEEP_DURATION_RESET_LOW, SLEEP_DURATION_RESET_HI);
592 release_locality(chip, tpm_dev.locality, 0);
593 return rc;
594}
595
596static bool tpm_tis_i2c_req_canceled(struct tpm_chip *chip, u8 status)
597{
598 return (status == TPM_STS_COMMAND_READY);
599}
600
601static const struct tpm_class_ops tpm_tis_i2c = {
602 .flags = TPM_OPS_AUTO_STARTUP,
603 .status = tpm_tis_i2c_status,
604 .recv = tpm_tis_i2c_recv,
605 .send = tpm_tis_i2c_send,
606 .cancel = tpm_tis_i2c_ready,
607 .req_complete_mask = TPM_STS_DATA_AVAIL | TPM_STS_VALID,
608 .req_complete_val = TPM_STS_DATA_AVAIL | TPM_STS_VALID,
609 .req_canceled = tpm_tis_i2c_req_canceled,
610};
611
612static int tpm_tis_i2c_init(struct device *dev)
613{
614 u32 vendor;
615 int rc = 0;
616 struct tpm_chip *chip;
617
618 chip = tpmm_chip_alloc(dev, &tpm_tis_i2c);
619 if (IS_ERR(chip))
620 return PTR_ERR(chip);
621
622
623 chip->timeout_a = msecs_to_jiffies(TIS_SHORT_TIMEOUT);
624 chip->timeout_b = msecs_to_jiffies(TIS_LONG_TIMEOUT);
625 chip->timeout_c = msecs_to_jiffies(TIS_SHORT_TIMEOUT);
626 chip->timeout_d = msecs_to_jiffies(TIS_SHORT_TIMEOUT);
627
628 if (request_locality(chip, 0) != 0) {
629 dev_err(dev, "could not request locality\n");
630 rc = -ENODEV;
631 goto out_err;
632 }
633
634
635 if (iic_tpm_read(TPM_DID_VID(0), (u8 *)&vendor, 4) < 0) {
636 dev_err(dev, "could not read vendor id\n");
637 rc = -EIO;
638 goto out_release;
639 }
640
641 if (vendor == TPM_TIS_I2C_DID_VID_9645) {
642 tpm_dev.chip_type = SLB9645;
643 } else if (vendor == TPM_TIS_I2C_DID_VID_9635) {
644 tpm_dev.chip_type = SLB9635;
645 } else {
646 dev_err(dev, "vendor id did not match! ID was %08x\n", vendor);
647 rc = -ENODEV;
648 goto out_release;
649 }
650
651 dev_info(dev, "1.2 TPM (device-id 0x%X)\n", vendor >> 16);
652
653 tpm_dev.chip = chip;
654
655 return tpm_chip_register(chip);
656out_release:
657 release_locality(chip, tpm_dev.locality, 1);
658 tpm_dev.client = NULL;
659out_err:
660 return rc;
661}
662
663static const struct i2c_device_id tpm_tis_i2c_table[] = {
664 {"tpm_i2c_infineon"},
665 {"slb9635tt"},
666 {"slb9645tt"},
667 {},
668};
669
670MODULE_DEVICE_TABLE(i2c, tpm_tis_i2c_table);
671
672#ifdef CONFIG_OF
673static const struct of_device_id tpm_tis_i2c_of_match[] = {
674 {.compatible = "infineon,tpm_i2c_infineon"},
675 {.compatible = "infineon,slb9635tt"},
676 {.compatible = "infineon,slb9645tt"},
677 {},
678};
679MODULE_DEVICE_TABLE(of, tpm_tis_i2c_of_match);
680#endif
681
682static SIMPLE_DEV_PM_OPS(tpm_tis_i2c_ops, tpm_pm_suspend, tpm_pm_resume);
683
684static int tpm_tis_i2c_probe(struct i2c_client *client,
685 const struct i2c_device_id *id)
686{
687 int rc;
688 struct device *dev = &(client->dev);
689
690 if (tpm_dev.client != NULL) {
691 dev_err(dev, "This driver only supports one client at a time\n");
692 return -EBUSY;
693 }
694
695 if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
696 dev_err(dev, "no algorithms associated to the i2c bus\n");
697 return -ENODEV;
698 }
699
700 tpm_dev.client = client;
701 rc = tpm_tis_i2c_init(&client->dev);
702 if (rc != 0) {
703 tpm_dev.client = NULL;
704 rc = -ENODEV;
705 }
706 return rc;
707}
708
709static int tpm_tis_i2c_remove(struct i2c_client *client)
710{
711 struct tpm_chip *chip = tpm_dev.chip;
712
713 tpm_chip_unregister(chip);
714 release_locality(chip, tpm_dev.locality, 1);
715 tpm_dev.client = NULL;
716
717 return 0;
718}
719
720static struct i2c_driver tpm_tis_i2c_driver = {
721 .id_table = tpm_tis_i2c_table,
722 .probe = tpm_tis_i2c_probe,
723 .remove = tpm_tis_i2c_remove,
724 .driver = {
725 .name = "tpm_i2c_infineon",
726 .pm = &tpm_tis_i2c_ops,
727 .of_match_table = of_match_ptr(tpm_tis_i2c_of_match),
728 },
729};
730
731module_i2c_driver(tpm_tis_i2c_driver);
732MODULE_AUTHOR("Peter Huewe <peter.huewe@infineon.com>");
733MODULE_DESCRIPTION("TPM TIS I2C Infineon Driver");
734MODULE_VERSION("2.2.0");
735MODULE_LICENSE("GPL");
736