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#include <linux/module.h>
28#include <linux/moduleparam.h>
29#include <linux/kernel.h>
30#include <linux/types.h>
31#include <linux/pci.h>
32#include <linux/pci_hotplug.h>
33#include <linux/acpi.h>
34#include <linux/pci-acpi.h>
35#include <linux/slab.h>
36
37#define MY_NAME "acpi_pcihp"
38
39#define dbg(fmt, arg...) do { if (debug_acpi) printk(KERN_DEBUG "%s: %s: " fmt , MY_NAME , __func__ , ## arg); } while (0)
40#define err(format, arg...) printk(KERN_ERR "%s: " format , MY_NAME , ## arg)
41#define info(format, arg...) printk(KERN_INFO "%s: " format , MY_NAME , ## arg)
42#define warn(format, arg...) printk(KERN_WARNING "%s: " format , MY_NAME , ## arg)
43
44#define METHOD_NAME__SUN "_SUN"
45#define METHOD_NAME_OSHP "OSHP"
46
47static bool debug_acpi;
48
49
50
51
52
53static acpi_status acpi_run_oshp(acpi_handle handle)
54{
55 acpi_status status;
56 struct acpi_buffer string = { ACPI_ALLOCATE_BUFFER, NULL };
57
58 acpi_get_name(handle, ACPI_FULL_PATHNAME, &string);
59
60
61 status = acpi_evaluate_object(handle, METHOD_NAME_OSHP, NULL, NULL);
62 if (ACPI_FAILURE(status))
63 if (status != AE_NOT_FOUND)
64 printk(KERN_ERR "%s:%s OSHP fails=0x%x\n",
65 __func__, (char *)string.pointer, status);
66 else
67 dbg("%s:%s OSHP not found\n",
68 __func__, (char *)string.pointer);
69 else
70 pr_debug("%s:%s OSHP passes\n", __func__,
71 (char *)string.pointer);
72
73 kfree(string.pointer);
74 return status;
75}
76
77
78
79
80
81
82
83
84int acpi_get_hp_hw_control_from_firmware(struct pci_dev *pdev, u32 flags)
85{
86 acpi_status status;
87 acpi_handle chandle, handle;
88 struct acpi_buffer string = { ACPI_ALLOCATE_BUFFER, NULL };
89
90 flags &= OSC_PCI_SHPC_NATIVE_HP_CONTROL;
91 if (!flags) {
92 err("Invalid flags %u specified!\n", flags);
93 return -EINVAL;
94 }
95
96
97
98
99
100
101
102
103
104
105 handle = acpi_find_root_bridge_handle(pdev);
106 if (handle) {
107 acpi_get_name(handle, ACPI_FULL_PATHNAME, &string);
108 dbg("Trying to get hotplug control for %s\n",
109 (char *)string.pointer);
110 status = acpi_pci_osc_control_set(handle, &flags, flags);
111 if (ACPI_SUCCESS(status))
112 goto got_one;
113 if (status == AE_SUPPORT)
114 goto no_control;
115 kfree(string.pointer);
116 string = (struct acpi_buffer){ ACPI_ALLOCATE_BUFFER, NULL };
117 }
118
119 handle = ACPI_HANDLE(&pdev->dev);
120 if (!handle) {
121
122
123
124
125 struct pci_bus *pbus;
126 for (pbus = pdev->bus; pbus; pbus = pbus->parent) {
127 handle = acpi_pci_get_bridge_handle(pbus);
128 if (handle)
129 break;
130 }
131 }
132
133 while (handle) {
134 acpi_get_name(handle, ACPI_FULL_PATHNAME, &string);
135 dbg("Trying to get hotplug control for %s \n",
136 (char *)string.pointer);
137 status = acpi_run_oshp(handle);
138 if (ACPI_SUCCESS(status))
139 goto got_one;
140 if (acpi_is_root_bridge(handle))
141 break;
142 chandle = handle;
143 status = acpi_get_parent(chandle, &handle);
144 if (ACPI_FAILURE(status))
145 break;
146 }
147no_control:
148 dbg("Cannot get control of hotplug hardware for pci %s\n",
149 pci_name(pdev));
150 kfree(string.pointer);
151 return -ENODEV;
152got_one:
153 dbg("Gained control for hotplug HW for pci %s (%s)\n",
154 pci_name(pdev), (char *)string.pointer);
155 kfree(string.pointer);
156 return 0;
157}
158EXPORT_SYMBOL(acpi_get_hp_hw_control_from_firmware);
159
160static int pcihp_is_ejectable(acpi_handle handle)
161{
162 acpi_status status;
163 unsigned long long removable;
164 if (!acpi_has_method(handle, "_ADR"))
165 return 0;
166 if (acpi_has_method(handle, "_EJ0"))
167 return 1;
168 status = acpi_evaluate_integer(handle, "_RMV", NULL, &removable);
169 if (ACPI_SUCCESS(status) && removable)
170 return 1;
171 return 0;
172}
173
174
175
176
177
178
179
180
181int acpi_pci_check_ejectable(struct pci_bus *pbus, acpi_handle handle)
182{
183 acpi_handle bridge_handle, parent_handle;
184
185 bridge_handle = acpi_pci_get_bridge_handle(pbus);
186 if (!bridge_handle)
187 return 0;
188 if ((ACPI_FAILURE(acpi_get_parent(handle, &parent_handle))))
189 return 0;
190 if (bridge_handle != parent_handle)
191 return 0;
192 return pcihp_is_ejectable(handle);
193}
194EXPORT_SYMBOL_GPL(acpi_pci_check_ejectable);
195
196static acpi_status
197check_hotplug(acpi_handle handle, u32 lvl, void *context, void **rv)
198{
199 int *found = (int *)context;
200 if (pcihp_is_ejectable(handle)) {
201 *found = 1;
202 return AE_CTRL_TERMINATE;
203 }
204 return AE_OK;
205}
206
207
208
209
210
211
212
213int acpi_pci_detect_ejectable(acpi_handle handle)
214{
215 int found = 0;
216
217 if (!handle)
218 return found;
219
220 acpi_walk_namespace(ACPI_TYPE_DEVICE, handle, 1,
221 check_hotplug, NULL, (void *)&found, NULL);
222 return found;
223}
224EXPORT_SYMBOL_GPL(acpi_pci_detect_ejectable);
225
226module_param(debug_acpi, bool, 0644);
227MODULE_PARM_DESC(debug_acpi, "Debugging mode for ACPI enabled or not");
228