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
113
114
115
116
117
118
119
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
147
148
149
150
151
152
153
154
155
156
157
158
159
160
|
/* Copyright 2022 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 <stdint.h>
#include <zephyr/zephyr.h>
#include <ztest.h>
#include <zephyr/drivers/gpio/gpio_emul.h>
#include "ec_commands.h"
#include "ec_tasks.h"
#include "emul/emul_isl923x.h"
#include "emul/tcpc/emul_ps8xxx.h"
#include "emul/tcpc/emul_tcpci.h"
#include "emul/tcpc/emul_tcpci_partner_snk.h"
#include "host_command.h"
#include "test/drivers/stubs.h"
#include "tcpm/tcpci.h"
#include "test/drivers/utils.h"
#include "test/drivers/test_state.h"
#define TEST_PORT USBC_PORT_C0
struct usbc_alt_mode_fixture {
const struct emul *tcpci_emul;
const struct emul *charger_emul;
struct tcpci_partner_data partner;
struct tcpci_snk_emul_data snk_ext;
};
static void connect_partner_to_port(struct usbc_alt_mode_fixture *fixture)
{
const struct emul *tcpc_emul = fixture->tcpci_emul;
struct tcpci_partner_data *partner_emul = &fixture->partner;
/* Set VBUS to vSafe0V initially. */
isl923x_emul_set_adc_vbus(fixture->charger_emul, 0);
tcpci_emul_set_reg(fixture->tcpci_emul, TCPC_REG_POWER_STATUS,
TCPC_REG_POWER_STATUS_VBUS_DET);
tcpci_emul_set_reg(fixture->tcpci_emul, TCPC_REG_EXT_STATUS,
TCPC_REG_EXT_STATUS_SAFE0V);
tcpci_tcpc_alert(0);
zassume_ok(tcpci_partner_connect_to_tcpci(partner_emul, tcpc_emul),
NULL);
/* Wait for PD negotiation and current ramp. */
k_sleep(K_SECONDS(10));
}
static void disconnect_partner_from_port(struct usbc_alt_mode_fixture *fixture)
{
zassume_ok(tcpci_emul_disconnect_partner(fixture->tcpci_emul), NULL);
isl923x_emul_set_adc_vbus(fixture->charger_emul, 0);
k_sleep(K_SECONDS(1));
}
static void *usbc_alt_mode_setup(void)
{
static struct usbc_alt_mode_fixture fixture;
struct tcpci_partner_data *partner = &fixture.partner;
struct tcpci_snk_emul_data *snk_ext = &fixture.snk_ext;
tcpci_partner_init(partner, PD_REV20);
partner->extensions = tcpci_snk_emul_init(snk_ext, partner, NULL);
/* Get references for the emulators */
fixture.tcpci_emul =
emul_get_binding(DT_LABEL(DT_NODELABEL(tcpci_emul)));
/* The configured TCPCI rev must match the emulator's supported rev. */
tcpc_config[TEST_PORT].flags |= TCPC_FLAGS_TCPCI_REV2_0;
tcpci_emul_set_rev(fixture.tcpci_emul, TCPCI_EMUL_REV2_0_VER1_1);
fixture.charger_emul =
emul_get_binding(DT_LABEL(DT_NODELABEL(isl923x_emul)));
/* Set up SOP discovery responses for DP adapter. */
partner->identity_vdm[VDO_INDEX_HDR] =
VDO(USB_SID_PD, /* structured VDM */ true,
VDO_CMDT(CMDT_RSP_ACK) | CMD_DISCOVER_IDENT);
partner->identity_vdm[VDO_INDEX_IDH] = VDO_IDH(
/* USB host */ false, /* USB device */ false, IDH_PTYPE_AMA,
/* modal operation */ true, USB_VID_GOOGLE);
partner->identity_vdm[VDO_INDEX_CSTAT] = 0xabcdabcd;
partner->identity_vdm[VDO_INDEX_PRODUCT] = VDO_PRODUCT(0x1234, 0x5678);
/* Hardware version 1, firmware version 2 */
partner->identity_vdm[VDO_INDEX_AMA] = 0x12000000;
partner->identity_vdos = VDO_INDEX_AMA + 1;
/* Support DisplayPort VID. */
partner->svids_vdm[VDO_INDEX_HDR] =
VDO(USB_SID_PD, /* structured VDM */ true,
VDO_CMDT(CMDT_RSP_ACK) | CMD_DISCOVER_SVID);
partner->svids_vdm[VDO_INDEX_HDR + 1] =
VDO_SVID(USB_SID_DISPLAYPORT, 0);
partner->svids_vdos = VDO_INDEX_HDR + 2;
/* Support one mode for DisplayPort VID. Copied from Hoho. */
partner->modes_vdm[VDO_INDEX_HDR] =
VDO(USB_SID_DISPLAYPORT, /* structured VDM */ true,
VDO_CMDT(CMDT_RSP_ACK) | CMD_DISCOVER_MODES);
partner->modes_vdm[VDO_INDEX_HDR + 1] = VDO_MODE_DP(
0, MODE_DP_PIN_C, 1, CABLE_PLUG, MODE_DP_V13, MODE_DP_SNK);
partner->modes_vdos = VDO_INDEX_HDR + 2;
/* Sink 5V 3A. */
snk_ext->pdo[1] = PDO_FIXED(5000, 3000, PDO_FIXED_UNCONSTRAINED);
return &fixture;
}
static void usbc_alt_mode_before(void *data)
{
/* Set chipset to ON, this will set TCPM to DRP */
test_set_chipset_to_s0();
/* TODO(b/214401892): Check why need to give time TCPM to spin */
k_sleep(K_SECONDS(1));
connect_partner_to_port((struct usbc_alt_mode_fixture *)data);
}
static void usbc_alt_mode_after(void *data)
{
disconnect_partner_from_port((struct usbc_alt_mode_fixture *)data);
}
ZTEST_F(usbc_alt_mode, verify_discovery)
{
uint8_t response_buffer[EC_LPC_HOST_PACKET_SIZE];
struct ec_response_typec_discovery *discovery =
(struct ec_response_typec_discovery *)response_buffer;
host_cmd_typec_discovery(TEST_PORT, TYPEC_PARTNER_SOP,
response_buffer, sizeof(response_buffer));
/* The host command does not count the VDM header in identity_count. */
zassert_equal(discovery->identity_count,
this->partner.identity_vdos - 1,
"Expected %d identity VDOs, got %d",
this->partner.identity_vdos - 1,
discovery->identity_count);
zassert_mem_equal(discovery->discovery_vdo,
this->partner.identity_vdm + 1,
discovery->identity_count *
sizeof(*discovery->discovery_vdo),
"Discovered SOP identity ACK did not match");
zassert_equal(discovery->svid_count, 1, "Expected 1 SVID, got %d",
discovery->svid_count);
zassert_equal(discovery->svids[0].svid, USB_SID_DISPLAYPORT,
"Expected SVID 0x%0000x, got 0x%0000x",
USB_SID_DISPLAYPORT, discovery->svids[0].svid);
zassert_equal(discovery->svids[0].mode_count, 1,
"Expected 1 DP mode, got %d",
discovery->svids[0].mode_count);
zassert_equal(discovery->svids[0].mode_vdo[0],
this->partner.modes_vdm[1],
"DP mode VDOs did not match");
}
ZTEST_SUITE(usbc_alt_mode, drivers_predicate_post_main, usbc_alt_mode_setup,
usbc_alt_mode_before, usbc_alt_mode_after, NULL);
|
