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
161
162
163
164
165
166
167
168
169
170
171
172
173
|
/* Copyright 2022 The ChromiumOS Authors
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
#include <zephyr/logging/log.h>
LOG_MODULE_REGISTER(tcpci_drp_emul, CONFIG_TCPCI_EMUL_LOG_LEVEL);
#include <zephyr/sys/byteorder.h>
#include <zephyr/kernel.h>
#include "common.h"
#include "emul/tcpc/emul_tcpci.h"
#include "emul/tcpc/emul_tcpci_partner_common.h"
#include "emul/tcpc/emul_tcpci_partner_drp.h"
#include "emul/tcpc/emul_tcpci_partner_snk.h"
#include "emul/tcpc/emul_tcpci_partner_src.h"
#include "tcpm/tcpci.h"
#include "usb_pd.h"
/**
* @brief Handle SOP messages as TCPCI dual role device
*
* @param ext Pointer to USB-C DRP device emulator extension
* @param common_data Pointer to USB-C device emulator common data
* @param msg Pointer to received message
*
* @return TCPCI_PARTNER_COMMON_MSG_HANDLED Message was handled
* @return TCPCI_PARTNER_COMMON_MSG_NOT_HANDLED Message wasn't handled
*/
static enum tcpci_partner_handler_res
tcpci_drp_emul_handle_sop_msg(struct tcpci_partner_extension *ext,
struct tcpci_partner_data *common_data,
const struct tcpci_emul_msg *msg)
{
struct tcpci_drp_emul_data *data =
CONTAINER_OF(ext, struct tcpci_drp_emul_data, ext);
uint16_t pwr_status;
uint16_t header;
header = sys_get_le16(msg->buf);
if (PD_HEADER_CNT(header)) {
/* Handle data message */
switch (PD_HEADER_TYPE(header)) {
case PD_DATA_REQUEST:
if (common_data->power_role == PD_ROLE_SINK) {
/* As sink we shouldn't accept request */
tcpci_partner_send_control_msg(
common_data, PD_CTRL_REJECT, 0);
return TCPCI_PARTNER_COMMON_MSG_HANDLED;
}
/* As source, let source handler to handle this */
return TCPCI_PARTNER_COMMON_MSG_NOT_HANDLED;
case PD_DATA_SOURCE_CAP:
if (common_data->power_role == PD_ROLE_SOURCE) {
/* As source we shouldn't respond */
return TCPCI_PARTNER_COMMON_MSG_HANDLED;
}
/* As sink, let sink handler to handle this */
return TCPCI_PARTNER_COMMON_MSG_NOT_HANDLED;
}
} else {
/* Handle control message */
switch (PD_HEADER_TYPE(header)) {
case PD_CTRL_PR_SWAP:
tcpci_partner_send_control_msg(common_data,
PD_CTRL_ACCEPT, 0);
data->in_pwr_swap = true;
return TCPCI_PARTNER_COMMON_MSG_HANDLED;
case PD_CTRL_PS_RDY:
if (!data->in_pwr_swap) {
return TCPCI_PARTNER_COMMON_MSG_NOT_HANDLED;
}
data->in_pwr_swap = false;
/* Reset counters */
common_data->sop_msg_id = 0;
common_data->sop_recv_msg_id = -1;
/* Perform power role swap */
if (common_data->power_role == PD_ROLE_SOURCE) {
/* Disable VBUS if emulator was source */
tcpci_emul_get_reg(common_data->tcpci_emul,
TCPC_REG_POWER_STATUS,
&pwr_status);
pwr_status &= ~TCPC_REG_POWER_STATUS_VBUS_PRES;
tcpci_emul_set_reg(common_data->tcpci_emul,
TCPC_REG_POWER_STATUS,
pwr_status);
/* Reconnect as sink */
common_data->power_role = PD_ROLE_SINK;
} else {
/* Reconnect as source */
common_data->power_role = PD_ROLE_SOURCE;
}
tcpci_partner_send_control_msg(common_data,
PD_CTRL_PS_RDY, 0);
/* Reconnect to TCPCI emulator */
tcpci_partner_connect_to_tcpci(common_data,
common_data->tcpci_emul);
return TCPCI_PARTNER_COMMON_MSG_HANDLED;
}
}
return TCPCI_PARTNER_COMMON_MSG_NOT_HANDLED;
}
void tcpci_drp_emul_set_dr_in_first_pdo(uint32_t *pdo)
{
*pdo |= PDO_FIXED_DUAL_ROLE;
}
/**
* @brief Perform action required by DRP device on hard reset. Reset role to
* initial values
*
* @param ext Pointer to USB-C DRP device emulator extension
* @param common_data Pointer to USB-C device emulator common data
*/
static void tcpci_drp_emul_hard_reset(struct tcpci_partner_extension *ext,
struct tcpci_partner_data *common_data)
{
struct tcpci_drp_emul_data *data =
CONTAINER_OF(ext, struct tcpci_drp_emul_data, ext);
tcpci_partner_common_hard_reset_as_role(common_data,
data->initial_power_role);
}
/** USB-C DRP device extension callbacks */
struct tcpci_partner_extension_ops tcpci_drp_emul_ops = {
.sop_msg_handler = tcpci_drp_emul_handle_sop_msg,
.hard_reset = tcpci_drp_emul_hard_reset,
.soft_reset = NULL,
.disconnect = NULL,
.connect = NULL,
};
struct tcpci_partner_extension *
tcpci_drp_emul_init(struct tcpci_drp_emul_data *data,
struct tcpci_partner_data *common_data,
enum pd_power_role power_role,
struct tcpci_partner_extension *src_ext,
struct tcpci_partner_extension *snk_ext)
{
struct tcpci_partner_extension *drp_ext = &data->ext;
struct tcpci_src_emul_data *src_data =
CONTAINER_OF(src_ext, struct tcpci_src_emul_data, ext);
struct tcpci_snk_emul_data *snk_data =
CONTAINER_OF(snk_ext, struct tcpci_snk_emul_data, ext);
data->in_pwr_swap = false;
tcpci_drp_emul_set_dr_in_first_pdo(src_data->pdo);
tcpci_drp_emul_set_dr_in_first_pdo(snk_data->pdo);
/* Use common handler to initialize roles */
data->initial_power_role = power_role;
tcpci_partner_common_hard_reset_as_role(common_data, power_role);
drp_ext->ops = &tcpci_drp_emul_ops;
/* Put sink as next extension to DRP */
drp_ext->next = snk_ext;
/* Put source after last extension in sink extensions chain */
while (snk_ext->next != NULL) {
snk_ext = snk_ext->next;
}
snk_ext->next = src_ext;
return drp_ext;
}
|
