1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
|
/* Copyright 2015 The Chromium OS Authors. All rights reserved.
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
#include "byteorder.h"
#include "console.h"
#include "extension.h"
#include "link_defs.h"
#include "util.h"
#define CPRINTF(format, args...) cprintf(CC_EXTENSION, format, ## args)
static uint32_t extension_route_command(uint16_t command_code,
void *buffer,
size_t in_size,
size_t *out_size)
{
struct extension_command *cmd_p;
struct extension_command *end_p;
cmd_p = (struct extension_command *)&__extension_cmds;
end_p = (struct extension_command *)&__extension_cmds_end;
#ifdef CONFIG_BOARD_ID_SUPPORT
if (board_id_is_mismatched()) {
switch (command_code) {
case EXTENSION_FW_UPGRADE:
case VENDOR_CC_REPORT_TPM_STATE:
case VENDOR_CC_TURN_UPDATE_ON:
case EXTENSION_POST_RESET:
break;
default:
CPRINTF("%s: ignoring command 0x%x "
"due to board ID mismatch\n",
__func__, command_code);
return VENDOR_RC_NO_SUCH_COMMAND;
}
}
#endif
while (cmd_p != end_p) {
if (cmd_p->command_code == command_code)
return cmd_p->handler(command_code, buffer,
in_size, out_size);
cmd_p++;
}
CPRINTF("%s: handler %d not found\n", __func__, command_code);
/* This covers the case of the handler not found. */
*out_size = 0;
return VENDOR_RC_NO_SUCH_COMMAND;
}
void usb_extension_route_command(uint16_t command_code,
void *buffer,
size_t in_size,
size_t *out_size)
{
uint32_t rv;
uint8_t *buf = buffer; /* Cache it for easy pointer arithmetics. */
size_t buf_size;
switch (command_code) {
#ifdef CR50_DEV
case VENDOR_CC_IMMEDIATE_RESET:
case VENDOR_CC_INVALIDATE_INACTIVE_RW:
case VENDOR_CC_SET_BOARD_ID:
#endif /* defined(CR50_DEV) */
case EXTENSION_POST_RESET: /* Always need to be able to reset. */
case VENDOR_CC_GET_BOARD_ID:
case VENDOR_CC_TURN_UPDATE_ON:
/*
* The return code normally put into the TPM response header
* is not present in the USB response. Vendor command return
* code is guaranteed to fit in a byte. Let's keep space for
* it in the front of the buffer.
*/
buf_size = *out_size - 1;
rv = extension_route_command(command_code, buffer,
in_size, &buf_size);
/*
* Copy actual response, if any, one byte up, to free room for
* the return code.
*/
if (buf_size)
memmove(buf + 1, buf, buf_size);
*out_size = buf_size + 1;
break;
default:
/* Otherwise, we don't allow this command. */
CPRINTF("%s: ignoring vendor cmd %d\n", __func__, command_code);
*out_size = 1;
rv = VENDOR_RC_NO_SUCH_COMMAND;
break;
}
buf[0] = rv; /* We care about LSB only. */
}
uint32_t tpm_extension_route_command(uint16_t command_code,
void *buffer,
size_t in_size,
size_t *out_size)
{
/*
* TODO(aaboagye): Determine what commands (if any) should be filtered.
*/
return extension_route_command(command_code, buffer, in_size, out_size);
}
|
