Skip to content
Snippets Groups Projects
cmd_tpm.c 4.28 KiB
Newer Older
  • Learn to ignore specific revisions
  • /*
     * Copyright (c) 2011 The Chromium OS Authors.
     *
     * See file CREDITS for list of people who contributed to this
     * project.
     *
     * 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; either version 2 of
     * the License, or (at your option) any later version.
     *
     * This program is distributed in the hope that it will be useful,
     * but WITHOUT ANY WARRANTY; without even the implied warranty of
     * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
     * GNU General Public License for more details.
     *
     * You should have received a copy of the GNU General Public License
     * along with this program; if not, write to the Free Software
     * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
     * MA 02111-1307 USA
     */
    
    #include <common.h>
    #include <command.h>
    #include <tpm.h>
    
    #define MAX_TRANSACTION_SIZE 30
    
    /*
     * tpm_write() expects a variable number of parameters: the internal address
     * followed by data to write, byte by byte.
     *
     * Returns 0 on success or -1 on errors (wrong arguments or TPM failure).
     */
    static int tpm_process(int argc, char * const argv[], cmd_tbl_t *cmdtp)
    {
    	u8 tpm_buffer[MAX_TRANSACTION_SIZE];
    	u32 write_size, read_size;
    	char *p;
    	int rv = -1;
    
    	for (write_size = 0; write_size < argc; write_size++) {
    		u32 datum = simple_strtoul(argv[write_size], &p, 0);
    		if (*p || (datum > 0xff)) {
    			printf("\n%s: bad data value\n\n", argv[write_size]);
    			cmd_usage(cmdtp);
    			return rv;
    		}
    		tpm_buffer[write_size] = (u8)datum;
    	}
    
    	read_size = sizeof(tpm_buffer);
    	if (!tis_sendrecv(tpm_buffer, write_size, tpm_buffer, &read_size)) {
    		int i;
    		puts("Got TPM response:\n");
    		for (i = 0; i < read_size; i++)
    			printf(" %2.2x", tpm_buffer[i]);
    		puts("\n");
    		rv = 0;
    	} else {
    		puts("tpm command failed\n");
    	}
    	return rv;
    }
    
    
    #define CHECK(exp) do {							\
    		int _rv = exp;						\
    		if (_rv) {						\
    			printf("CHECK: %s %d %x\n", #exp, __LINE__, _rv);\
    		}							\
    	} while (0)
    
    static int tpm_process_stress(int repeat_count)
    
    	int i;
    
    	u8 request[] = {0x0, 0xc1,
    			0x0, 0x0, 0x0, 0x16,
    			0x0, 0x0, 0x0, 0x65,
    			0x0, 0x0, 0x0, 0x4,
    			0x0, 0x0, 0x0, 0x4,
    			0x0, 0x0, 0x1, 0x9};
    	u8 response[MAX_TRANSACTION_SIZE];
    	u32 rlength = MAX_TRANSACTION_SIZE;
    
    	CHECK(tis_init());
    
    	for (i = 0; i < repeat_count; i++) {
    		CHECK(tis_open());
    		rv = tis_sendrecv(request, sizeof(request), response, &rlength);
    		if (rv) {
    			printf("tpm test failed at step %d with 0x%x\n", i, rv);
    			CHECK(tis_close());
    			break;
    		}
    		CHECK(tis_close());
    		if ((response[6] || response[7] || response[8] || response[9])
    		    && response[9] != 0x26) {
    			/* Ignore postinit errors */
    			printf("tpm command failed at step %d\n"
    			       "tpm error code: %02x%02x%02x%02x\n", i,
    			       response[6], response[7],
    			       response[8], response[9]);
    			rv = -1;
    			break;
    		}
    	}
    	return rv;
    }
    
    
    static int do_tpm_many(cmd_tbl_t *cmdtp, int flag,
    		       int argc, char * const argv[], int repeat_count)
    
    {
    	int rv = 0;
    
    	if (argc < 7 && repeat_count == 0) {
    
    		puts("command should be at least six bytes in size\n");
    		return -1;
    	}
    
    
    	if (repeat_count > 0) {
    		rv = tpm_process_stress(repeat_count);
    		return rv;
    	}
    
    
    	if (tis_init()) {
    		puts("tis_init() failed!\n");
    		return -1;
    	}
    
    	if (tis_open()) {
    		puts("tis_open() failed!\n");
    		return -1;
    	}
    
    	rv = tpm_process(argc - 1, argv + 1, cmdtp);
    
    	if (tis_close()) {
    		puts("tis_close() failed!\n");
    		rv = -1;
    	}
    
    	return rv;
    }
    
    
    
    static int do_tpm(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
    {
    	return do_tpm_many(cmdtp, flag, argc, argv, 0);
    }
    
    
    
    U_BOOT_CMD(tpm, MAX_TRANSACTION_SIZE, 1, do_tpm,
    	   "<byte> [<byte> ...]   - write data and read response",
    	   "send arbitrary data (at least 6 bytes) to the TPM "
    	   "device and read the response"
    );
    
    
    static int do_tpm_stress(cmd_tbl_t *cmdtp, int flag,
    			 int argc, char * const argv[])
    {
    	long unsigned int n;
    	int rv;
    
    	if (argc != 2) {
    		puts("usage: tpm_stress <count>\n");
    		return -1;
    	}
    
    	rv = strict_strtoul(argv[1], 10, &n);
    	if (rv) {
    		puts("tpm_stress: bad count");
    		return -1;
    	}
    
    	return do_tpm_many(cmdtp, flag, argc, argv, n);
    }
    
    U_BOOT_CMD(tpm_stress, 2, 1, do_tpm_stress,
    	   "<n>   - stress-test communication with TPM",
    	   "Repeat a TPM transaction (request-response) N times"
    );