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
|
/* 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.
*/
/* Samus PD-custom USB mux driver. */
#include "common.h"
#include "gpio.h"
#include "usb_mux.h"
#include "util.h"
struct usb_port_mux {
enum gpio_signal ss1_en_l;
enum gpio_signal ss2_en_l;
enum gpio_signal dp_mode_l;
enum gpio_signal dp_polarity;
enum gpio_signal ss1_dp_mode;
enum gpio_signal ss2_dp_mode;
};
static const struct usb_port_mux mux_gpios[] = {
{
.ss1_en_l = GPIO_USB_C0_SS1_EN_L,
.ss2_en_l = GPIO_USB_C0_SS2_EN_L,
.dp_mode_l = GPIO_USB_C0_DP_MODE_L,
.dp_polarity = GPIO_USB_C0_DP_POLARITY,
.ss1_dp_mode = GPIO_USB_C0_SS1_DP_MODE,
.ss2_dp_mode = GPIO_USB_C0_SS2_DP_MODE,
},
{
.ss1_en_l = GPIO_USB_C1_SS1_EN_L,
.ss2_en_l = GPIO_USB_C1_SS2_EN_L,
.dp_mode_l = GPIO_USB_C1_DP_MODE_L,
.dp_polarity = GPIO_USB_C1_DP_POLARITY,
.ss1_dp_mode = GPIO_USB_C1_SS1_DP_MODE,
.ss2_dp_mode = GPIO_USB_C1_SS2_DP_MODE,
},
};
BUILD_ASSERT(ARRAY_SIZE(mux_gpios) == CONFIG_USB_PD_PORT_COUNT);
static int board_init_usb_mux(int port)
{
return EC_SUCCESS;
}
static int board_set_usb_mux(int port, mux_state_t mux_state)
{
const struct usb_port_mux *usb_mux = mux_gpios + port;
int polarity = mux_state & MUX_POLARITY_INVERTED;
/* reset everything */
gpio_set_level(usb_mux->ss1_en_l, 1);
gpio_set_level(usb_mux->ss2_en_l, 1);
gpio_set_level(usb_mux->dp_mode_l, 1);
gpio_set_level(usb_mux->dp_polarity, 1);
gpio_set_level(usb_mux->ss1_dp_mode, 1);
gpio_set_level(usb_mux->ss2_dp_mode, 1);
if (!(mux_state & (MUX_USB_ENABLED | MUX_DP_ENABLED)))
/* everything is already disabled, we can return */
return EC_SUCCESS;
if (mux_state & MUX_USB_ENABLED)
/* USB 3.0 uses 2 superspeed lanes */
gpio_set_level(polarity ? usb_mux->ss2_dp_mode :
usb_mux->ss1_dp_mode, 0);
if (mux_state & MUX_DP_ENABLED) {
/* DP uses available superspeed lanes (x2 or x4) */
gpio_set_level(usb_mux->dp_polarity, polarity);
gpio_set_level(usb_mux->dp_mode_l, 0);
}
/* switch on superspeed lanes */
gpio_set_level(usb_mux->ss1_en_l, 0);
gpio_set_level(usb_mux->ss2_en_l, 0);
return EC_SUCCESS;
}
static int board_get_usb_mux(int port, mux_state_t *mux_state)
{
const struct usb_port_mux *usb_mux = mux_gpios + port;
*mux_state = 0;
if (!gpio_get_level(usb_mux->ss1_dp_mode) ||
!gpio_get_level(usb_mux->ss2_dp_mode))
*mux_state |= MUX_USB_ENABLED;
if (!gpio_get_level(usb_mux->dp_mode_l))
*mux_state |= MUX_DP_ENABLED;
if (gpio_get_level(usb_mux->dp_polarity))
*mux_state |= MUX_POLARITY_INVERTED;
return EC_SUCCESS;
}
const struct usb_mux_driver board_custom_usb_mux_driver = {
.init = board_init_usb_mux,
.set = board_set_usb_mux,
.get = board_get_usb_mux,
};
struct usb_mux usb_muxes[CONFIG_USB_PD_PORT_COUNT] = {
{
.driver = &board_custom_usb_mux_driver,
},
{
.driver = &board_custom_usb_mux_driver,
},
};
|
