| /* |
| * TPM utility functions |
| * |
| * Copyright (c) 2010 - 2015 IBM Corporation |
| * Authors: |
| * Stefan Berger <stefanb@us.ibm.com> |
| * |
| * This library is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU Lesser General Public |
| * License as published by the Free Software Foundation; either |
| * version 2 of the License, or (at your option) any later version. |
| * |
| * This library 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 |
| * Lesser General Public License for more details. |
| * |
| * You should have received a copy of the GNU Lesser General Public |
| * License along with this library; if not, see <http://www.gnu.org/licenses/> |
| */ |
| |
| #include "tpm_util.h" |
| #include "tpm_int.h" |
| |
| /* |
| * A basic test of a TPM device. We expect a well formatted response header |
| * (error response is fine) within one second. |
| */ |
| static int tpm_util_test(int fd, |
| unsigned char *request, |
| size_t requestlen, |
| uint16_t *return_tag) |
| { |
| struct tpm_resp_hdr *resp; |
| fd_set readfds; |
| int n; |
| struct timeval tv = { |
| .tv_sec = 1, |
| .tv_usec = 0, |
| }; |
| unsigned char buf[1024]; |
| |
| n = write(fd, request, requestlen); |
| if (n < 0) { |
| return errno; |
| } |
| if (n != requestlen) { |
| return EFAULT; |
| } |
| |
| FD_ZERO(&readfds); |
| FD_SET(fd, &readfds); |
| |
| /* wait for a second */ |
| n = select(fd + 1, &readfds, NULL, NULL, &tv); |
| if (n != 1) { |
| return errno; |
| } |
| |
| n = read(fd, &buf, sizeof(buf)); |
| if (n < sizeof(struct tpm_resp_hdr)) { |
| return EFAULT; |
| } |
| |
| resp = (struct tpm_resp_hdr *)buf; |
| /* check the header */ |
| if (be32_to_cpu(resp->len) != n) { |
| return EBADMSG; |
| } |
| |
| *return_tag = be16_to_cpu(resp->tag); |
| |
| return 0; |
| } |
| |
| /* |
| * Probe for the TPM device in the back |
| * Returns 0 on success with the version of the probed TPM set, 1 on failure. |
| */ |
| int tpm_util_test_tpmdev(int tpm_fd, TPMVersion *tpm_version) |
| { |
| /* |
| * Sending a TPM1.2 command to a TPM2 should return a TPM1.2 |
| * header (tag = 0xc4) and error code (TPM_BADTAG = 0x1e) |
| * |
| * Sending a TPM2 command to a TPM 2 will give a TPM 2 tag in the |
| * header. |
| * Sending a TPM2 command to a TPM 1.2 will give a TPM 1.2 tag |
| * in the header and an error code. |
| */ |
| const struct tpm_req_hdr test_req = { |
| .tag = cpu_to_be16(TPM_TAG_RQU_COMMAND), |
| .len = cpu_to_be32(sizeof(test_req)), |
| .ordinal = cpu_to_be32(TPM_ORD_GetTicks), |
| }; |
| |
| const struct tpm_req_hdr test_req_tpm2 = { |
| .tag = cpu_to_be16(TPM2_ST_NO_SESSIONS), |
| .len = cpu_to_be32(sizeof(test_req_tpm2)), |
| .ordinal = cpu_to_be32(TPM2_CC_ReadClock), |
| }; |
| uint16_t return_tag; |
| int ret; |
| |
| /* Send TPM 2 command */ |
| ret = tpm_util_test(tpm_fd, (unsigned char *)&test_req_tpm2, |
| sizeof(test_req_tpm2), &return_tag); |
| /* TPM 2 would respond with a tag of TPM2_ST_NO_SESSIONS */ |
| if (!ret && return_tag == TPM2_ST_NO_SESSIONS) { |
| *tpm_version = TPM_VERSION_2_0; |
| return 0; |
| } |
| |
| /* Send TPM 1.2 command */ |
| ret = tpm_util_test(tpm_fd, (unsigned char *)&test_req, |
| sizeof(test_req), &return_tag); |
| if (!ret && return_tag == TPM_TAG_RSP_COMMAND) { |
| *tpm_version = TPM_VERSION_1_2; |
| /* this is a TPM 1.2 */ |
| return 0; |
| } |
| |
| *tpm_version = TPM_VERSION_UNSPEC; |
| |
| return 1; |
| } |