tpm.c 14.6 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
/*
 * Copyright (C) 2004 IBM Corporation
 *
 * Authors:
 * Leendert van Doorn <leendert@watson.ibm.com>
 * Dave Safford <safford@watson.ibm.com>
 * Reiner Sailer <sailer@watson.ibm.com>
 * Kylene Hall <kjhall@us.ibm.com>
 *
 * Maintained by: <tpmdd_devel@lists.sourceforge.net>
 *
 * Device driver for TCG/TCPA TPM (trusted platform module).
 * Specifications at www.trustedcomputinggroup.org	 
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation, version 2 of the
 * License.
 * 
 * Note, the TPM chip is not interrupt driven (only polling)
 * and can have very long timeouts (minutes!). Hence the unusual
22
 * calls to msleep.
L
Linus Torvalds 已提交
23 24 25 26 27 28 29 30
 *
 */

#include <linux/sched.h>
#include <linux/poll.h>
#include <linux/spinlock.h>
#include "tpm.h"

31 32 33 34 35 36
enum tpm_const {
	TPM_MINOR = 224,	/* officially assigned */
	TPM_BUFSIZE = 2048,
	TPM_NUM_DEVICES = 256,
	TPM_NUM_MASK_ENTRIES = TPM_NUM_DEVICES / (8 * sizeof(int))
};
L
Linus Torvalds 已提交
37 38 39

static LIST_HEAD(tpm_chip_list);
static DEFINE_SPINLOCK(driver_lock);
40
static int dev_mask[TPM_NUM_MASK_ENTRIES];
L
Linus Torvalds 已提交
41 42 43 44 45

static void user_reader_timeout(unsigned long ptr)
{
	struct tpm_chip *chip = (struct tpm_chip *) ptr;

K
Kylene Jo Hall 已提交
46 47 48
	schedule_work(&chip->work);
}

K
Kylene Jo Hall 已提交
49
static void timeout_work(void *ptr)
K
Kylene Jo Hall 已提交
50 51 52
{
	struct tpm_chip *chip = ptr;

L
Linus Torvalds 已提交
53 54 55 56 57 58 59 60 61 62 63 64
	down(&chip->buffer_mutex);
	atomic_set(&chip->data_pending, 0);
	memset(chip->data_buffer, 0, TPM_BUFSIZE);
	up(&chip->buffer_mutex);
}

/*
 * Internal kernel interface to transmit TPM commands
 */
static ssize_t tpm_transmit(struct tpm_chip *chip, const char *buf,
			    size_t bufsiz)
{
K
Kylene Hall 已提交
65
	ssize_t rc;
L
Linus Torvalds 已提交
66
	u32 count;
67
	unsigned long stop;
L
Linus Torvalds 已提交
68

69
	count = be32_to_cpu(*((__be32 *) (buf + 2)));
L
Linus Torvalds 已提交
70 71 72 73

	if (count == 0)
		return -ENODATA;
	if (count > bufsiz) {
74
		dev_err(chip->dev,
A
Al Viro 已提交
75
			"invalid count value %x %zx \n", count, bufsiz);
L
Linus Torvalds 已提交
76 77 78 79 80
		return -E2BIG;
	}

	down(&chip->tpm_mutex);

K
Kylene Jo Hall 已提交
81
	if ((rc = chip->vendor.send(chip, (u8 *) buf, count)) < 0) {
82
		dev_err(chip->dev,
K
Kylene Hall 已提交
83 84
			"tpm_transmit: tpm_send: error %zd\n", rc);
		goto out;
L
Linus Torvalds 已提交
85 86
	}

87
	stop = jiffies + 2 * 60 * HZ;
L
Linus Torvalds 已提交
88
	do {
K
Kylene Jo Hall 已提交
89 90 91
		u8 status = chip->vendor.status(chip);
		if ((status & chip->vendor.req_complete_mask) ==
		    chip->vendor.req_complete_val)
L
Linus Torvalds 已提交
92
			goto out_recv;
K
Kylene Hall 已提交
93

K
Kylene Jo Hall 已提交
94
		if ((status == chip->vendor.req_canceled)) {
95
			dev_err(chip->dev, "Operation Canceled\n");
K
Kylene Hall 已提交
96 97 98 99 100
			rc = -ECANCELED;
			goto out;
		}

		msleep(TPM_TIMEOUT);	/* CHECK */
L
Linus Torvalds 已提交
101
		rmb();
102
	} while (time_before(jiffies, stop));
L
Linus Torvalds 已提交
103

K
Kylene Jo Hall 已提交
104
	chip->vendor.cancel(chip);
105
	dev_err(chip->dev, "Operation Timed out\n");
K
Kylene Hall 已提交
106 107
	rc = -ETIME;
	goto out;
L
Linus Torvalds 已提交
108 109

out_recv:
K
Kylene Jo Hall 已提交
110
	rc = chip->vendor.recv(chip, (u8 *) buf, bufsiz);
K
Kylene Hall 已提交
111
	if (rc < 0)
112
		dev_err(chip->dev,
K
Kylene Hall 已提交
113 114
			"tpm_transmit: tpm_recv: error %zd\n", rc);
out:
L
Linus Torvalds 已提交
115
	up(&chip->tpm_mutex);
K
Kylene Hall 已提交
116
	return rc;
L
Linus Torvalds 已提交
117 118 119
}

#define TPM_DIGEST_SIZE 20
120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146
#define TPM_ERROR_SIZE 10
#define TPM_RET_CODE_IDX 6
#define TPM_GET_CAP_RET_SIZE_IDX 10
#define TPM_GET_CAP_RET_UINT32_1_IDX 14
#define TPM_GET_CAP_RET_UINT32_2_IDX 18
#define TPM_GET_CAP_RET_UINT32_3_IDX 22
#define TPM_GET_CAP_RET_UINT32_4_IDX 26

#define TPM_CAP_IDX 13
#define TPM_CAP_SUBCAP_IDX 21

enum tpm_capabilities {
	TPM_CAP_PROP = 5,
};

enum tpm_sub_capabilities {
	TPM_CAP_PROP_PCR = 0x1,
	TPM_CAP_PROP_MANUFACTURER = 0x3,
};

/*
 * This is a semi generic GetCapability command for use
 * with the capability type TPM_CAP_PROP or TPM_CAP_FLAG
 * and their associated sub_capabilities.
 */

static const u8 tpm_cap[] = {
L
Linus Torvalds 已提交
147 148 149
	0, 193,			/* TPM_TAG_RQU_COMMAND */
	0, 0, 0, 22,		/* length */
	0, 0, 0, 101,		/* TPM_ORD_GetCapability */
150 151 152
	0, 0, 0, 0,		/* TPM_CAP_<TYPE> */
	0, 0, 0, 4,		/* TPM_CAP_SUB_<TYPE> size */
	0, 0, 1, 0		/* TPM_CAP_SUB_<TYPE> */
L
Linus Torvalds 已提交
153 154
};

155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170
static ssize_t transmit_cmd(struct tpm_chip *chip, u8 *data, int len,
			    char *desc)
{
	int err;

	len = tpm_transmit(chip, data, len);
	if (len <  0)
		return len;
	if (len == TPM_ERROR_SIZE) {
		err = be32_to_cpu(*((__be32 *) (data + TPM_RET_CODE_IDX)));
		dev_dbg(chip->dev, "A TPM error (%d) occurred %s\n", err, desc);
		return err;
	}
	return 0;
}

171
static const u8 pcrread[] = {
L
Linus Torvalds 已提交
172 173 174 175 176 177
	0, 193,			/* TPM_TAG_RQU_COMMAND */
	0, 0, 0, 14,		/* length */
	0, 0, 0, 21,		/* TPM_ORD_PcrRead */
	0, 0, 0, 0		/* PCR index */
};

178 179
ssize_t tpm_show_pcrs(struct device *dev, struct device_attribute *attr,
		      char *buf)
L
Linus Torvalds 已提交
180
{
181 182
	u8 data[30];
	ssize_t rc;
183 184
	int i, j, num_pcrs;
	__be32 index;
L
Linus Torvalds 已提交
185 186
	char *str = buf;

187
	struct tpm_chip *chip = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
188 189 190
	if (chip == NULL)
		return -ENODEV;

191 192 193 194 195 196 197
	memcpy(data, tpm_cap, sizeof(tpm_cap));
	data[TPM_CAP_IDX] = TPM_CAP_PROP;
	data[TPM_CAP_SUBCAP_IDX] = TPM_CAP_PROP_PCR;

	rc = transmit_cmd(chip, data, sizeof(data),
			"attempting to determine the number of PCRS");
	if (rc)
K
Kylene Hall 已提交
198
		return 0;
L
Linus Torvalds 已提交
199

200
	num_pcrs = be32_to_cpu(*((__be32 *) (data + 14)));
L
Linus Torvalds 已提交
201 202 203 204
	for (i = 0; i < num_pcrs; i++) {
		memcpy(data, pcrread, sizeof(pcrread));
		index = cpu_to_be32(i);
		memcpy(data + 10, &index, 4);
205 206 207
		rc = transmit_cmd(chip, data, sizeof(data),
				"attempting to read a PCR");
		if (rc)
K
Kylene Hall 已提交
208
			goto out;
L
Linus Torvalds 已提交
209 210 211 212 213
		str += sprintf(str, "PCR-%02d: ", i);
		for (j = 0; j < TPM_DIGEST_SIZE; j++)
			str += sprintf(str, "%02X ", *(data + 10 + j));
		str += sprintf(str, "\n");
	}
K
Kylene Hall 已提交
214
out:
L
Linus Torvalds 已提交
215 216
	return str - buf;
}
217
EXPORT_SYMBOL_GPL(tpm_show_pcrs);
L
Linus Torvalds 已提交
218 219

#define  READ_PUBEK_RESULT_SIZE 314
220
static const u8 readpubek[] = {
L
Linus Torvalds 已提交
221 222 223 224 225
	0, 193,			/* TPM_TAG_RQU_COMMAND */
	0, 0, 0, 30,		/* length */
	0, 0, 0, 124,		/* TPM_ORD_ReadPubek */
};

226 227
ssize_t tpm_show_pubek(struct device *dev, struct device_attribute *attr,
		       char *buf)
L
Linus Torvalds 已提交
228
{
K
Kylene Hall 已提交
229
	u8 *data;
230
	ssize_t err;
231
	int i, rc;
L
Linus Torvalds 已提交
232 233
	char *str = buf;

234
	struct tpm_chip *chip = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
235 236 237
	if (chip == NULL)
		return -ENODEV;

A
Andrew Morton 已提交
238
	data = kzalloc(READ_PUBEK_RESULT_SIZE, GFP_KERNEL);
K
Kylene Hall 已提交
239 240 241
	if (!data)
		return -ENOMEM;

L
Linus Torvalds 已提交
242 243
	memcpy(data, readpubek, sizeof(readpubek));

244 245 246
	err = transmit_cmd(chip, data, READ_PUBEK_RESULT_SIZE,
			"attempting to read the PUBEK");
	if (err)
247
		goto out;
L
Linus Torvalds 已提交
248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269

	/* 
	   ignore header 10 bytes
	   algorithm 32 bits (1 == RSA )
	   encscheme 16 bits
	   sigscheme 16 bits
	   parameters (RSA 12->bytes: keybit, #primes, expbit)  
	   keylenbytes 32 bits
	   256 byte modulus
	   ignore checksum 20 bytes
	 */

	str +=
	    sprintf(str,
		    "Algorithm: %02X %02X %02X %02X\nEncscheme: %02X %02X\n"
		    "Sigscheme: %02X %02X\nParameters: %02X %02X %02X %02X"
		    " %02X %02X %02X %02X %02X %02X %02X %02X\n"
		    "Modulus length: %d\nModulus: \n",
		    data[10], data[11], data[12], data[13], data[14],
		    data[15], data[16], data[17], data[22], data[23],
		    data[24], data[25], data[26], data[27], data[28],
		    data[29], data[30], data[31], data[32], data[33],
K
Kylene Jo Hall 已提交
270
		    be32_to_cpu(*((__be32 *) (data + 34))));
L
Linus Torvalds 已提交
271 272

	for (i = 0; i < 256; i++) {
K
Kylene Jo Hall 已提交
273
		str += sprintf(str, "%02X ", data[i + 38]);
L
Linus Torvalds 已提交
274 275 276
		if ((i + 1) % 16 == 0)
			str += sprintf(str, "\n");
	}
277
out:
278
	rc = str - buf;
K
Kylene Hall 已提交
279 280
	kfree(data);
	return rc;
L
Linus Torvalds 已提交
281
}
282
EXPORT_SYMBOL_GPL(tpm_show_pubek);
L
Linus Torvalds 已提交
283

284 285
#define CAP_VERSION_1_1 6
#define CAP_VERSION_IDX 13
286
static const u8 cap_version[] = {
L
Linus Torvalds 已提交
287 288 289
	0, 193,			/* TPM_TAG_RQU_COMMAND */
	0, 0, 0, 18,		/* length */
	0, 0, 0, 101,		/* TPM_ORD_GetCapability */
290
	0, 0, 0, 0,
L
Linus Torvalds 已提交
291 292 293
	0, 0, 0, 0
};

294 295
ssize_t tpm_show_caps(struct device *dev, struct device_attribute *attr,
		      char *buf)
L
Linus Torvalds 已提交
296
{
297 298
	u8 data[30];
	ssize_t rc;
L
Linus Torvalds 已提交
299 300
	char *str = buf;

301
	struct tpm_chip *chip = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
302 303 304
	if (chip == NULL)
		return -ENODEV;

305 306 307
	memcpy(data, tpm_cap, sizeof(tpm_cap));
	data[TPM_CAP_IDX] = TPM_CAP_PROP;
	data[TPM_CAP_SUBCAP_IDX] = TPM_CAP_PROP_MANUFACTURER;
L
Linus Torvalds 已提交
308

309 310 311 312
	rc = transmit_cmd(chip, data, sizeof(data),
			"attempting to determine the manufacturer");
	if (rc)
		return 0;
L
Linus Torvalds 已提交
313 314

	str += sprintf(str, "Manufacturer: 0x%x\n",
315
		       be32_to_cpu(*((__be32 *) (data + TPM_GET_CAP_RET_UINT32_1_IDX))));
L
Linus Torvalds 已提交
316 317

	memcpy(data, cap_version, sizeof(cap_version));
318 319 320 321 322
	data[CAP_VERSION_IDX] = CAP_VERSION_1_1;
	rc = transmit_cmd(chip, data, sizeof(data),
			"attempting to determine the 1.1 version");
	if (rc)
		goto out;
L
Linus Torvalds 已提交
323

324 325 326 327
	str += sprintf(str,
		       "TCG version: %d.%d\nFirmware version: %d.%d\n",
		       (int) data[14], (int) data[15], (int) data[16],
		       (int) data[17]);
L
Linus Torvalds 已提交
328

329
out:
L
Linus Torvalds 已提交
330 331
	return str - buf;
}
332 333 334 335 336 337 338 339 340
EXPORT_SYMBOL_GPL(tpm_show_caps);

ssize_t tpm_store_cancel(struct device *dev, struct device_attribute *attr,
			const char *buf, size_t count)
{
	struct tpm_chip *chip = dev_get_drvdata(dev);
	if (chip == NULL)
		return 0;

K
Kylene Jo Hall 已提交
341
	chip->vendor.cancel(chip);
342 343 344
	return count;
}
EXPORT_SYMBOL_GPL(tpm_store_cancel);
L
Linus Torvalds 已提交
345 346 347 348 349 350 351 352 353 354 355 356

/*
 * Device file system interface to the TPM
 */
int tpm_open(struct inode *inode, struct file *file)
{
	int rc = 0, minor = iminor(inode);
	struct tpm_chip *chip = NULL, *pos;

	spin_lock(&driver_lock);

	list_for_each_entry(pos, &tpm_chip_list, list) {
K
Kylene Jo Hall 已提交
357
		if (pos->vendor.miscdev.minor == minor) {
L
Linus Torvalds 已提交
358 359 360 361 362 363 364 365 366 367 368
			chip = pos;
			break;
		}
	}

	if (chip == NULL) {
		rc = -ENODEV;
		goto err_out;
	}

	if (chip->num_opens) {
A
Andrew Morton 已提交
369
		dev_dbg(chip->dev, "Another process owns this TPM\n");
L
Linus Torvalds 已提交
370 371 372 373 374
		rc = -EBUSY;
		goto err_out;
	}

	chip->num_opens++;
375
	get_device(chip->dev);
L
Linus Torvalds 已提交
376 377 378 379 380 381

	spin_unlock(&driver_lock);

	chip->data_buffer = kmalloc(TPM_BUFSIZE * sizeof(u8), GFP_KERNEL);
	if (chip->data_buffer == NULL) {
		chip->num_opens--;
382
		put_device(chip->dev);
L
Linus Torvalds 已提交
383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401
		return -ENOMEM;
	}

	atomic_set(&chip->data_pending, 0);

	file->private_data = chip;
	return 0;

err_out:
	spin_unlock(&driver_lock);
	return rc;
}
EXPORT_SYMBOL_GPL(tpm_open);

int tpm_release(struct inode *inode, struct file *file)
{
	struct tpm_chip *chip = file->private_data;

	spin_lock(&driver_lock);
K
Kylene Hall 已提交
402
	file->private_data = NULL;
L
Linus Torvalds 已提交
403
	chip->num_opens--;
404
	del_singleshot_timer_sync(&chip->user_read_timer);
405
	flush_scheduled_work();
L
Linus Torvalds 已提交
406
	atomic_set(&chip->data_pending, 0);
407
	put_device(chip->dev);
K
Kylene Hall 已提交
408 409
	kfree(chip->data_buffer);
	spin_unlock(&driver_lock);
L
Linus Torvalds 已提交
410 411 412 413
	return 0;
}
EXPORT_SYMBOL_GPL(tpm_release);

A
Andrew Morton 已提交
414
ssize_t tpm_write(struct file *file, const char __user *buf,
K
Kylene Jo Hall 已提交
415
		  size_t size, loff_t *off)
L
Linus Torvalds 已提交
416 417 418 419 420 421
{
	struct tpm_chip *chip = file->private_data;
	int in_size = size, out_size;

	/* cannot perform a write until the read has cleared
	   either via tpm_read or a user_read_timer timeout */
422 423
	while (atomic_read(&chip->data_pending) != 0)
		msleep(TPM_TIMEOUT);
L
Linus Torvalds 已提交
424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442

	down(&chip->buffer_mutex);

	if (in_size > TPM_BUFSIZE)
		in_size = TPM_BUFSIZE;

	if (copy_from_user
	    (chip->data_buffer, (void __user *) buf, in_size)) {
		up(&chip->buffer_mutex);
		return -EFAULT;
	}

	/* atomic tpm command send and result receive */
	out_size = tpm_transmit(chip, chip->data_buffer, TPM_BUFSIZE);

	atomic_set(&chip->data_pending, out_size);
	up(&chip->buffer_mutex);

	/* Set a timeout by which the reader must come claim the result */
443
	mod_timer(&chip->user_read_timer, jiffies + (60 * HZ));
L
Linus Torvalds 已提交
444 445 446 447 448

	return in_size;
}
EXPORT_SYMBOL_GPL(tpm_write);

K
Kylene Jo Hall 已提交
449 450
ssize_t tpm_read(struct file *file, char __user *buf,
		 size_t size, loff_t *off)
L
Linus Torvalds 已提交
451 452
{
	struct tpm_chip *chip = file->private_data;
453
	int ret_size;
L
Linus Torvalds 已提交
454

455
	del_singleshot_timer_sync(&chip->user_read_timer);
456
	flush_scheduled_work();
457 458 459 460 461
	ret_size = atomic_read(&chip->data_pending);
	atomic_set(&chip->data_pending, 0);
	if (ret_size > 0) {	/* relay data */
		if (size < ret_size)
			ret_size = size;
L
Linus Torvalds 已提交
462 463

		down(&chip->buffer_mutex);
464
		if (copy_to_user(buf, chip->data_buffer, ret_size))
465
			ret_size = -EFAULT;
L
Linus Torvalds 已提交
466 467 468 469 470 471 472
		up(&chip->buffer_mutex);
	}

	return ret_size;
}
EXPORT_SYMBOL_GPL(tpm_read);

473
void tpm_remove_hardware(struct device *dev)
L
Linus Torvalds 已提交
474
{
475
	struct tpm_chip *chip = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
476 477

	if (chip == NULL) {
478
		dev_err(dev, "No device data found\n");
L
Linus Torvalds 已提交
479 480 481 482 483 484 485 486 487
		return;
	}

	spin_lock(&driver_lock);

	list_del(&chip->list);

	spin_unlock(&driver_lock);

488
	dev_set_drvdata(dev, NULL);
K
Kylene Jo Hall 已提交
489 490
	misc_deregister(&chip->vendor.miscdev);
	kfree(chip->vendor.miscdev.name);
L
Linus Torvalds 已提交
491

K
Kylene Jo Hall 已提交
492
	sysfs_remove_group(&dev->kobj, chip->vendor.attr_group);
493
	tpm_bios_log_teardown(chip->bios_dir);
L
Linus Torvalds 已提交
494

K
Kylene Jo Hall 已提交
495 496
	dev_mask[chip->dev_num / TPM_NUM_MASK_ENTRIES] &=
	    ~(1 << (chip->dev_num % TPM_NUM_MASK_ENTRIES));
L
Linus Torvalds 已提交
497 498 499

	kfree(chip);

500
	put_device(dev);
L
Linus Torvalds 已提交
501
}
502
EXPORT_SYMBOL_GPL(tpm_remove_hardware);
L
Linus Torvalds 已提交
503 504 505 506 507 508 509 510 511 512 513

static u8 savestate[] = {
	0, 193,			/* TPM_TAG_RQU_COMMAND */
	0, 0, 0, 10,		/* blob length (in bytes) */
	0, 0, 0, 152		/* TPM_ORD_SaveState */
};

/*
 * We are about to suspend. Save the TPM state
 * so that it can be restored.
 */
514
int tpm_pm_suspend(struct device *dev, pm_message_t pm_state)
L
Linus Torvalds 已提交
515
{
516
	struct tpm_chip *chip = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
517 518 519 520 521 522 523 524 525 526 527 528
	if (chip == NULL)
		return -ENODEV;

	tpm_transmit(chip, savestate, sizeof(savestate));
	return 0;
}
EXPORT_SYMBOL_GPL(tpm_pm_suspend);

/*
 * Resume from a power safe. The BIOS already restored
 * the TPM state.
 */
529
int tpm_pm_resume(struct device *dev)
L
Linus Torvalds 已提交
530
{
531
	struct tpm_chip *chip = dev_get_drvdata(dev);
L
Linus Torvalds 已提交
532 533 534 535 536 537 538 539 540 541 542 543 544 545 546

	if (chip == NULL)
		return -ENODEV;

	return 0;
}
EXPORT_SYMBOL_GPL(tpm_pm_resume);

/*
 * Called from tpm_<specific>.c probe function only for devices 
 * the driver has determined it should claim.  Prior to calling
 * this function the specific probe function has called pci_enable_device
 * upon errant exit from this function specific probe function should call
 * pci_disable_device
 */
547 548
struct tpm_chip *tpm_register_hardware(struct device *dev, const struct tpm_vendor_specific
				       *entry)
L
Linus Torvalds 已提交
549
{
550 551 552
#define DEVNAME_SIZE 7

	char *devname;
L
Linus Torvalds 已提交
553 554 555 556
	struct tpm_chip *chip;
	int i, j;

	/* Driver specific per-device data */
A
Andrew Morton 已提交
557
	chip = kzalloc(sizeof(*chip), GFP_KERNEL);
L
Linus Torvalds 已提交
558
	if (chip == NULL)
559
		return NULL;
L
Linus Torvalds 已提交
560 561 562 563 564

	init_MUTEX(&chip->buffer_mutex);
	init_MUTEX(&chip->tpm_mutex);
	INIT_LIST_HEAD(&chip->list);

K
Kylene Jo Hall 已提交
565 566
	INIT_WORK(&chip->work, timeout_work, chip);

567 568 569 570
	init_timer(&chip->user_read_timer);
	chip->user_read_timer.function = user_reader_timeout;
	chip->user_read_timer.data = (unsigned long) chip;

K
Kylene Jo Hall 已提交
571
	memcpy(&chip->vendor, entry, sizeof(struct tpm_vendor_specific));
L
Linus Torvalds 已提交
572 573 574

	chip->dev_num = -1;

575 576
	for (i = 0; i < TPM_NUM_MASK_ENTRIES; i++)
		for (j = 0; j < 8 * sizeof(int); j++)
L
Linus Torvalds 已提交
577
			if ((dev_mask[i] & (1 << j)) == 0) {
578 579
				chip->dev_num =
				    i * TPM_NUM_MASK_ENTRIES + j;
L
Linus Torvalds 已提交
580 581 582 583 584 585
				dev_mask[i] |= 1 << j;
				goto dev_num_search_complete;
			}

dev_num_search_complete:
	if (chip->dev_num < 0) {
A
Andrew Morton 已提交
586
		dev_err(dev, "No available tpm device numbers\n");
L
Linus Torvalds 已提交
587
		kfree(chip);
588
		return NULL;
L
Linus Torvalds 已提交
589
	} else if (chip->dev_num == 0)
K
Kylene Jo Hall 已提交
590
		chip->vendor.miscdev.minor = TPM_MINOR;
L
Linus Torvalds 已提交
591
	else
K
Kylene Jo Hall 已提交
592
		chip->vendor.miscdev.minor = MISC_DYNAMIC_MINOR;
L
Linus Torvalds 已提交
593

594 595
	devname = kmalloc(DEVNAME_SIZE, GFP_KERNEL);
	scnprintf(devname, DEVNAME_SIZE, "%s%d", "tpm", chip->dev_num);
K
Kylene Jo Hall 已提交
596
	chip->vendor.miscdev.name = devname;
L
Linus Torvalds 已提交
597

K
Kylene Jo Hall 已提交
598
	chip->vendor.miscdev.dev = dev;
599
	chip->dev = get_device(dev);
L
Linus Torvalds 已提交
600

K
Kylene Jo Hall 已提交
601
	if (misc_register(&chip->vendor.miscdev)) {
602
		dev_err(chip->dev,
L
Linus Torvalds 已提交
603
			"unable to misc_register %s, minor %d\n",
K
Kylene Jo Hall 已提交
604 605
			chip->vendor.miscdev.name,
			chip->vendor.miscdev.minor);
606
		put_device(dev);
L
Linus Torvalds 已提交
607 608
		kfree(chip);
		dev_mask[i] &= !(1 << j);
609
		return NULL;
L
Linus Torvalds 已提交
610 611
	}

K
Kylene Hall 已提交
612 613
	spin_lock(&driver_lock);

614
	dev_set_drvdata(dev, chip);
L
Linus Torvalds 已提交
615 616 617

	list_add(&chip->list, &tpm_chip_list);

K
Kylene Hall 已提交
618 619
	spin_unlock(&driver_lock);

K
Kylene Jo Hall 已提交
620
	sysfs_create_group(&dev->kobj, chip->vendor.attr_group);
L
Linus Torvalds 已提交
621

622 623
	chip->bios_dir = tpm_bios_log_setup(devname);

624
	return chip;
L
Linus Torvalds 已提交
625 626 627 628 629 630 631
}
EXPORT_SYMBOL_GPL(tpm_register_hardware);

MODULE_AUTHOR("Leendert van Doorn (leendert@watson.ibm.com)");
MODULE_DESCRIPTION("TPM Driver");
MODULE_VERSION("2.0");
MODULE_LICENSE("GPL");