From patchwork Wed Mar 9 17:39:30 2016 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Stefan Berger X-Patchwork-Id: 595164 Return-Path: X-Original-To: incoming@patchwork.ozlabs.org Delivered-To: patchwork-incoming@bilbo.ozlabs.org Received: from lists.sourceforge.net (lists.sourceforge.net [216.34.181.88]) (using TLSv1 with cipher DHE-RSA-AES256-SHA (256/256 bits)) (No client certificate requested) by ozlabs.org (Postfix) with ESMTPS id B00F314031D for ; Thu, 10 Mar 2016 04:40:02 +1100 (AEDT) Received: from localhost ([127.0.0.1] helo=sfs-ml-2.v29.ch3.sourceforge.com) by sfs-ml-2.v29.ch3.sourceforge.com with esmtp (Exim 4.76) (envelope-from ) id 1adi5Z-0002Ho-3p; Wed, 09 Mar 2016 17:40:01 +0000 Received: from sog-mx-4.v43.ch3.sourceforge.com ([172.29.43.194] helo=mx.sourceforge.net) by sfs-ml-2.v29.ch3.sourceforge.com with esmtp (Exim 4.76) (envelope-from ) id 1adi5Y-0002Hi-6A for tpmdd-devel@lists.sourceforge.net; Wed, 09 Mar 2016 17:40:00 +0000 X-ACL-Warn: Received: from e32.co.us.ibm.com ([32.97.110.150]) by sog-mx-4.v43.ch3.sourceforge.com with esmtps (TLSv1:AES256-SHA:256) (Exim 4.76) id 1adi5X-0002k6-2E for tpmdd-devel@lists.sourceforge.net; Wed, 09 Mar 2016 17:40:00 +0000 Received: from localhost by e32.co.us.ibm.com with IBM ESMTP SMTP Gateway: Authorized Use Only! Violators will be prosecuted for from ; Wed, 9 Mar 2016 10:39:38 -0700 Received: from d03dlp02.boulder.ibm.com (9.17.202.178) by e32.co.us.ibm.com (192.168.1.132) with IBM ESMTP SMTP Gateway: Authorized Use Only! Violators will be prosecuted; Wed, 9 Mar 2016 10:39:37 -0700 X-IBM-Helo: d03dlp02.boulder.ibm.com X-IBM-MailFrom: stefanb@linux.vnet.ibm.com X-IBM-RcptTo: tpmdd-devel@lists.sourceforge.net Received: from b01cxnp22033.gho.pok.ibm.com (b01cxnp22033.gho.pok.ibm.com [9.57.198.23]) by d03dlp02.boulder.ibm.com (Postfix) with ESMTP id 756313E40052 for ; Wed, 9 Mar 2016 10:39:36 -0700 (MST) Received: from d01av01.pok.ibm.com (d01av01.pok.ibm.com [9.56.224.215]) by b01cxnp22033.gho.pok.ibm.com (8.14.9/8.14.9/NCO v10.0) with ESMTP id u29Hdaxp5964010 for ; Wed, 9 Mar 2016 17:39:36 GMT Received: from d01av01.pok.ibm.com (localhost [127.0.0.1]) by d01av01.pok.ibm.com (8.14.4/8.14.4/NCO v10.0 AVout) with ESMTP id u29HdZBb021319 for ; Wed, 9 Mar 2016 12:39:35 -0500 Received: from dhcp-9-2-140-43.watson.ibm.com (dhcp-9-2-140-28.watson.ibm.com [9.2.140.28]) by d01av01.pok.ibm.com (8.14.4/8.14.4/NCO v10.0 AVin) with ESMTP id u29HdW4N020852; Wed, 9 Mar 2016 12:39:35 -0500 From: Stefan Berger To: tpmdd-devel@lists.sourceforge.net Date: Wed, 9 Mar 2016 12:39:30 -0500 Message-Id: <1457545170-30120-12-git-send-email-stefanb@linux.vnet.ibm.com> X-Mailer: git-send-email 2.4.3 In-Reply-To: <1457545170-30120-1-git-send-email-stefanb@linux.vnet.ibm.com> References: <1457545170-30120-1-git-send-email-stefanb@linux.vnet.ibm.com> X-TM-AS-MML: disable X-Content-Scanned: Fidelis XPS MAILER x-cbid: 16030917-0005-0000-0000-00001D50391A X-Spam-Score: -0.0 (/) X-Spam-Report: Spam Filtering performed by mx.sourceforge.net. See http://spamassassin.org/tag/ for more details. -0.0 RP_MATCHES_RCVD Envelope sender domain matches handover relay domain X-Headers-End: 1adi5X-0002k6-2E Subject: [tpmdd-devel] [PATCH v6 11/11] A test program for vTPM device creation X-BeenThere: tpmdd-devel@lists.sourceforge.net X-Mailman-Version: 2.1.9 Precedence: list List-Id: Tpm Device Driver maintainance List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , MIME-Version: 1.0 Errors-To: tpmdd-devel-bounces@lists.sourceforge.net This patch provides a program that is for testing purposes only. Build it using the following commands: make headers_install ARCH=x86_64 INSTALL_HDR_PATH=/usr gcc vtpmctrl.c -o vtpmctrl To use it: To create a device pair and have vtpmctrl listen for commands, display them and respond with TPM success messages do: Created TPM device /dev/tpm0; vTPM device has fd 4, major/minor = 10/224. In another shell do 00000000 00 c4 00 00 00 0a 00 00 00 00 00000012 Signed-off-by: Stefan Berger --- vtpmctrl.c | 163 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 163 insertions(+) create mode 100644 vtpmctrl.c diff --git a/vtpmctrl.c b/vtpmctrl.c new file mode 100644 index 0000000..071be45 --- /dev/null +++ b/vtpmctrl.c @@ -0,0 +1,163 @@ +/* + * vtpmctrl.c -- Linux vTPM driver control program + * + * (c) Copyright IBM Corporation 2015. + * + * Author: Stefan Berger + * + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are + * met: + * + * Redistributions of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * + * Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * + * Neither the names of the IBM Corporation nor the names of its + * contributors may be used to endorse or promote products derived from + * this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS + * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT + * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR + * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT + * HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, + * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT + * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, + * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY + * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT + * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE + * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. + */ + + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +int vtpmctrl_create(void) +{ + int fd, n, option, li, serverfd, nn; + struct vtpm_new_dev vtpm_new_dev = { + .flags = 0, + }; + char tpmdev[16]; + unsigned char buffer[4096]; + const unsigned char tpm_startup_resp[] = { + 0x00, 0xc4, 0x00, 0x00, 0x00, 0x0a, 0x00, 0x00, 0x00, 0x00 + }; + const unsigned char timeout_req[] = { + 0x00, 0xc1, 0x00, 0x00, 0x00, 0x16, 0x00, 0x00, 0x00, 0x65, + 0x00, 0x00, 0x00, 0x05, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, + 0x01, 0x15 + }; + const unsigned char timeout_res[] = { + 0x00, 0xc4, 0x00, 0x00, 0x00, 0x1e, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, + 0x00, 0x01, 0x00, 0x00, + 0x00, 0x02, 0x00, 0x00, + 0x00, 0x03, 0x00, 0x00, + 0x00, 0x04, 0x00, 0x00, + }; + const unsigned char duration_req[] = { + 0x00, 0xc1, 0x00, 0x00, 0x00, 0x16, 0x00, 0x00, 0x00, 0x65, + 0x00, 0x00, 0x00, 0x05, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00, + 0x01, 0x20 + }; + const unsigned char duration_res[] = { + 0x00, 0xc4, 0x00, 0x00, 0x00, 0x1a, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, + 0x00, 0x01, 0x00, 0x00, + 0x00, 0x02, 0x00, 0x00, + 0x00, 0x03, 0x00, 0x00, + }; + uint32_t ordinal; + + fd = open("/dev/vtpmx", O_RDWR); + if (fd < 0) { + perror("Could not open /dev/vtpmx"); + return 1; + } + + n = ioctl(fd, VTPM_NEW_DEV, &vtpm_new_dev); + if (n != 0) { + perror("ioctl to create new device failed"); + close(fd); + return 1; + } + + snprintf(tpmdev, sizeof(tpmdev), "/dev/tpm%u", + vtpm_new_dev.dev_num); + + serverfd = vtpm_new_dev.fd; + + printf("Created TPM device %s; vTPM device has fd %d, " + "major/minor = %u/%u.\n", + tpmdev, serverfd, vtpm_new_dev.major, vtpm_new_dev.minor); + + close(fd); + + while (1) { + n = read(serverfd, buffer, sizeof(buffer)); + if (n > 0) { + printf("Request with %d bytes:\n", n); + nn = 0; + while (nn < n) { + printf("0x%02x ", buffer[nn]); + nn++; + if (nn % 16 == 0) + printf("\n"); + } + printf("\n"); + ordinal = be32toh(*(uint32_t *)&(buffer[6])); + switch (ordinal) { + case 0x99: + n = write(serverfd, tpm_startup_resp, sizeof(tpm_startup_resp)); + break; + case 0x65: + if (!memcmp(timeout_req, buffer, sizeof(timeout_req))) { + n = write(serverfd, timeout_res, sizeof(timeout_res)); + + } else if (!memcmp(duration_req, buffer, sizeof(duration_req))) { + n = write(serverfd, duration_res, sizeof(duration_res)); + } else { + n = write(serverfd, tpm_startup_resp, sizeof(tpm_startup_resp)); + } + break; + default: + n = write(serverfd, tpm_startup_resp, sizeof(tpm_startup_resp)); + break; + } + if (n < 0) { + printf("Error from writing the response: %s\n", + strerror(errno)); + break; + } else { + printf("Sent response with %d bytes.\n", n); + } + } else { + break; + } + } + + return 0; +} + +int main(int argc, char *argv[]) +{ + return vtpmctrl_create(); +}