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
|
/* SPDX-License-Identifier: GPL-2.0-only */
#include <acpi/acpi_device.h>
#include <acpi/acpi_pld.h>
#include <acpi/acpigen.h>
#include <console/console.h>
#include <device/device.h>
#include <device/path.h>
#include "chip.h"
static bool usb_acpi_add_gpios_to_crs(struct drivers_usb_acpi_config *cfg)
{
if (cfg->privacy_gpio.pin_count)
return true;
if (cfg->reset_gpio.pin_count && !cfg->has_power_resource)
return true;
return false;
}
static int usb_acpi_write_gpio(struct acpi_gpio *gpio, int *curr_index)
{
int ret = -1;
if (gpio->pin_count == 0)
return ret;
acpi_device_write_gpio(gpio);
ret = *curr_index;
(*curr_index)++;
return ret;
}
static void usb_acpi_fill_ssdt_generator(const struct device *dev)
{
struct drivers_usb_acpi_config *config = dev->chip_info;
const char *path = acpi_device_path(dev);
struct acpi_pld pld;
if (!path || !config)
return;
/* Don't generate output for hubs, only ports */
if (config->type == UPC_TYPE_HUB)
return;
acpigen_write_scope(path);
if (config->desc)
acpigen_write_name_string("_DDN", config->desc);
acpigen_write_upc(config->type);
if (usb_acpi_get_pld(dev, &pld))
acpigen_write_pld(&pld);
else
printk(BIOS_ERR, "Error retrieving PLD for %s\n", path);
/* Resources */
if (usb_acpi_add_gpios_to_crs(config) == true) {
struct acpi_dp *dsd;
int idx = 0;
int reset_gpio_index = -1;
int privacy_gpio_index;
acpigen_write_name("_CRS");
acpigen_write_resourcetemplate_header();
if (!config->has_power_resource) {
reset_gpio_index = usb_acpi_write_gpio(
&config->reset_gpio, &idx);
}
privacy_gpio_index = usb_acpi_write_gpio(&config->privacy_gpio,
&idx);
acpigen_write_resourcetemplate_footer();
dsd = acpi_dp_new_table("_DSD");
if (reset_gpio_index >= 0)
acpi_dp_add_gpio(dsd, "reset-gpio", path,
reset_gpio_index, 0,
config->reset_gpio.active_low);
if (privacy_gpio_index >= 0)
acpi_dp_add_gpio(dsd, "privacy-gpio", path,
privacy_gpio_index, 0,
config->privacy_gpio.active_low);
acpi_dp_write(dsd);
}
if (config->has_power_resource) {
const struct acpi_power_res_params power_res_params = {
&config->reset_gpio,
config->reset_delay_ms,
config->reset_off_delay_ms,
&config->enable_gpio,
config->enable_delay_ms,
config->enable_off_delay_ms,
NULL,
0,
0
};
acpi_device_add_power_res(&power_res_params);
}
acpigen_pop_len();
printk(BIOS_INFO, "%s: %s at %s\n", path,
config->desc ? : dev->chip_ops->name, dev_path(dev));
}
static struct device_operations usb_acpi_ops = {
.read_resources = noop_read_resources,
.set_resources = noop_set_resources,
.scan_bus = scan_static_bus,
.acpi_fill_ssdt = usb_acpi_fill_ssdt_generator,
};
static void usb_acpi_enable(struct device *dev)
{
dev->ops = &usb_acpi_ops;
}
struct chip_operations drivers_usb_acpi_ops = {
CHIP_NAME("USB ACPI Device")
.enable_dev = usb_acpi_enable
};
bool usb_acpi_get_pld(const struct device *usb_device, struct acpi_pld *pld)
{
struct drivers_usb_acpi_config *config;
if (!usb_device || !usb_device->chip_info ||
usb_device->chip_ops != &drivers_usb_acpi_ops)
return false;
config = usb_device->chip_info;
if (config->use_custom_pld)
*pld = config->custom_pld;
else
acpi_pld_fill_usb(pld, config->type, &config->group);
return true;
}
|
