1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <linux/acpi.h>
17#include <linux/device.h>
18#include <linux/kernel.h>
19#include <linux/module.h>
20#include <linux/pci.h>
21
22#include <acpi/processor.h>
23
24#include <asm/cpu.h>
25
26#include "internal.h"
27
28#define _COMPONENT ACPI_PROCESSOR_COMPONENT
29
30ACPI_MODULE_NAME("processor");
31
32DEFINE_PER_CPU(struct acpi_processor *, processors);
33EXPORT_PER_CPU_SYMBOL(processors);
34
35
36
37
38
39struct acpi_processor_errata errata __read_mostly;
40EXPORT_SYMBOL_GPL(errata);
41
42static int acpi_processor_errata_piix4(struct pci_dev *dev)
43{
44 u8 value1 = 0;
45 u8 value2 = 0;
46
47
48 if (!dev)
49 return -EINVAL;
50
51
52
53
54
55 switch (dev->revision) {
56 case 0:
57 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4 A-step\n"));
58 break;
59 case 1:
60 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4 B-step\n"));
61 break;
62 case 2:
63 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4E\n"));
64 break;
65 case 3:
66 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found PIIX4M\n"));
67 break;
68 default:
69 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found unknown PIIX4\n"));
70 break;
71 }
72
73 switch (dev->revision) {
74
75 case 0:
76 case 1:
77
78
79
80
81
82
83
84 errata.piix4.throttle = 1;
85
86 case 2:
87 case 3:
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102 dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
103 PCI_DEVICE_ID_INTEL_82371AB,
104 PCI_ANY_ID, PCI_ANY_ID, NULL);
105 if (dev) {
106 errata.piix4.bmisx = pci_resource_start(dev, 4);
107 pci_dev_put(dev);
108 }
109
110
111
112
113
114
115
116
117
118
119 dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
120 PCI_DEVICE_ID_INTEL_82371AB_0,
121 PCI_ANY_ID, PCI_ANY_ID, NULL);
122 if (dev) {
123 pci_read_config_byte(dev, 0x76, &value1);
124 pci_read_config_byte(dev, 0x77, &value2);
125 if ((value1 & 0x80) || (value2 & 0x80))
126 errata.piix4.fdma = 1;
127 pci_dev_put(dev);
128 }
129
130 break;
131 }
132
133 if (errata.piix4.bmisx)
134 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
135 "Bus master activity detection (BM-IDE) erratum enabled\n"));
136 if (errata.piix4.fdma)
137 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
138 "Type-F DMA livelock erratum (C3 disabled)\n"));
139
140 return 0;
141}
142
143static int acpi_processor_errata(void)
144{
145 int result = 0;
146 struct pci_dev *dev = NULL;
147
148
149
150
151 dev = pci_get_subsys(PCI_VENDOR_ID_INTEL,
152 PCI_DEVICE_ID_INTEL_82371AB_3, PCI_ANY_ID,
153 PCI_ANY_ID, NULL);
154 if (dev) {
155 result = acpi_processor_errata_piix4(dev);
156 pci_dev_put(dev);
157 }
158
159 return result;
160}
161
162
163
164
165
166#ifdef CONFIG_ACPI_HOTPLUG_CPU
167int __weak acpi_map_cpu(acpi_handle handle,
168 phys_cpuid_t physid, int *pcpu)
169{
170 return -ENODEV;
171}
172
173int __weak acpi_unmap_cpu(int cpu)
174{
175 return -ENODEV;
176}
177
178int __weak arch_register_cpu(int cpu)
179{
180 return -ENODEV;
181}
182
183void __weak arch_unregister_cpu(int cpu) {}
184
185static int acpi_processor_hotadd_init(struct acpi_processor *pr)
186{
187 unsigned long long sta;
188 acpi_status status;
189 int ret;
190
191 if (invalid_phys_cpuid(pr->phys_id))
192 return -ENODEV;
193
194 status = acpi_evaluate_integer(pr->handle, "_STA", NULL, &sta);
195 if (ACPI_FAILURE(status) || !(sta & ACPI_STA_DEVICE_PRESENT))
196 return -ENODEV;
197
198 cpu_maps_update_begin();
199 cpu_hotplug_begin();
200
201 ret = acpi_map_cpu(pr->handle, pr->phys_id, &pr->id);
202 if (ret)
203 goto out;
204
205 ret = arch_register_cpu(pr->id);
206 if (ret) {
207 acpi_unmap_cpu(pr->id);
208 goto out;
209 }
210
211
212
213
214
215
216 pr_info("CPU%d has been hot-added\n", pr->id);
217 pr->flags.need_hotplug_init = 1;
218
219out:
220 cpu_hotplug_done();
221 cpu_maps_update_done();
222 return ret;
223}
224#else
225static inline int acpi_processor_hotadd_init(struct acpi_processor *pr)
226{
227 return -ENODEV;
228}
229#endif
230
231static int acpi_processor_get_info(struct acpi_device *device)
232{
233 union acpi_object object = { 0 };
234 struct acpi_buffer buffer = { sizeof(union acpi_object), &object };
235 struct acpi_processor *pr = acpi_driver_data(device);
236 int device_declaration = 0;
237 acpi_status status = AE_OK;
238 static int cpu0_initialized;
239 unsigned long long value;
240
241 acpi_processor_errata();
242
243
244
245
246
247 if (acpi_gbl_FADT.pm2_control_block && acpi_gbl_FADT.pm2_control_length) {
248 pr->flags.bm_control = 1;
249 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
250 "Bus mastering arbitration control present\n"));
251 } else
252 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
253 "No bus mastering arbitration control\n"));
254
255 if (!strcmp(acpi_device_hid(device), ACPI_PROCESSOR_OBJECT_HID)) {
256
257 status = acpi_evaluate_object(pr->handle, NULL, NULL, &buffer);
258 if (ACPI_FAILURE(status)) {
259 dev_err(&device->dev,
260 "Failed to evaluate processor object (0x%x)\n",
261 status);
262 return -ENODEV;
263 }
264
265 pr->acpi_id = object.processor.proc_id;
266 } else {
267
268
269
270
271 status = acpi_evaluate_integer(pr->handle, METHOD_NAME__UID,
272 NULL, &value);
273 if (ACPI_FAILURE(status)) {
274 dev_err(&device->dev,
275 "Failed to evaluate processor _UID (0x%x)\n",
276 status);
277 return -ENODEV;
278 }
279 device_declaration = 1;
280 pr->acpi_id = value;
281 }
282
283 pr->phys_id = acpi_get_phys_id(pr->handle, device_declaration,
284 pr->acpi_id);
285 if (invalid_phys_cpuid(pr->phys_id))
286 acpi_handle_debug(pr->handle, "failed to get CPU physical ID.\n");
287
288 pr->id = acpi_map_cpuid(pr->phys_id, pr->acpi_id);
289 if (!cpu0_initialized && !acpi_has_cpu_in_madt()) {
290 cpu0_initialized = 1;
291
292
293
294
295 if (invalid_logical_cpuid(pr->id) && (num_online_cpus() == 1))
296 pr->id = 0;
297 }
298
299
300
301
302
303
304 if (invalid_logical_cpuid(pr->id)) {
305 int ret = acpi_processor_hotadd_init(pr);
306 if (ret)
307 return ret;
308 }
309
310
311
312
313
314
315
316
317
318
319 sprintf(acpi_device_bid(device), "CPU%X", pr->id);
320 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Processor [%d:%d]\n", pr->id,
321 pr->acpi_id));
322
323 if (!object.processor.pblk_address)
324 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No PBLK (NULL address)\n"));
325 else if (object.processor.pblk_length != 6)
326 dev_err(&device->dev, "Invalid PBLK length [%d]\n",
327 object.processor.pblk_length);
328 else {
329 pr->throttling.address = object.processor.pblk_address;
330 pr->throttling.duty_offset = acpi_gbl_FADT.duty_offset;
331 pr->throttling.duty_width = acpi_gbl_FADT.duty_width;
332
333 pr->pblk = object.processor.pblk_address;
334
335
336
337
338
339
340
341
342 request_region(pr->throttling.address, 6, "ACPI CPU throttle");
343 }
344
345
346
347
348
349
350 status = acpi_evaluate_integer(pr->handle, "_SUN", NULL, &value);
351 if (ACPI_SUCCESS(status))
352 arch_fix_phys_package_id(pr->id, value);
353
354 return 0;
355}
356
357
358
359
360
361
362
363static DEFINE_PER_CPU(void *, processor_device_array);
364
365static int acpi_processor_add(struct acpi_device *device,
366 const struct acpi_device_id *id)
367{
368 struct acpi_processor *pr;
369 struct device *dev;
370 int result = 0;
371
372 pr = kzalloc(sizeof(struct acpi_processor), GFP_KERNEL);
373 if (!pr)
374 return -ENOMEM;
375
376 if (!zalloc_cpumask_var(&pr->throttling.shared_cpu_map, GFP_KERNEL)) {
377 result = -ENOMEM;
378 goto err_free_pr;
379 }
380
381 pr->handle = device->handle;
382 strcpy(acpi_device_name(device), ACPI_PROCESSOR_DEVICE_NAME);
383 strcpy(acpi_device_class(device), ACPI_PROCESSOR_CLASS);
384 device->driver_data = pr;
385
386 result = acpi_processor_get_info(device);
387 if (result)
388 return 0;
389
390#ifdef CONFIG_SMP
391 if (pr->id >= setup_max_cpus && pr->id != 0)
392 return 0;
393#endif
394
395 BUG_ON(pr->id >= nr_cpu_ids);
396
397
398
399
400
401
402 if (per_cpu(processor_device_array, pr->id) != NULL &&
403 per_cpu(processor_device_array, pr->id) != device) {
404 dev_warn(&device->dev,
405 "BIOS reported wrong ACPI id %d for the processor\n",
406 pr->id);
407
408 goto err;
409 }
410
411
412
413
414 per_cpu(processor_device_array, pr->id) = device;
415 per_cpu(processors, pr->id) = pr;
416
417 dev = get_cpu_device(pr->id);
418 if (!dev) {
419 result = -ENODEV;
420 goto err;
421 }
422
423 result = acpi_bind_one(dev, device);
424 if (result)
425 goto err;
426
427 pr->dev = dev;
428
429
430 if (device_attach(dev) >= 0)
431 return 1;
432
433 dev_err(dev, "Processor driver could not be attached\n");
434 acpi_unbind_one(dev);
435
436 err:
437 free_cpumask_var(pr->throttling.shared_cpu_map);
438 device->driver_data = NULL;
439 per_cpu(processors, pr->id) = NULL;
440 err_free_pr:
441 kfree(pr);
442 return result;
443}
444
445#ifdef CONFIG_ACPI_HOTPLUG_CPU
446
447
448
449
450static void acpi_processor_remove(struct acpi_device *device)
451{
452 struct acpi_processor *pr;
453
454 if (!device || !acpi_driver_data(device))
455 return;
456
457 pr = acpi_driver_data(device);
458 if (pr->id >= nr_cpu_ids)
459 goto out;
460
461
462
463
464
465
466
467
468
469 device_release_driver(pr->dev);
470 acpi_unbind_one(pr->dev);
471
472
473 per_cpu(processor_device_array, pr->id) = NULL;
474 per_cpu(processors, pr->id) = NULL;
475
476 cpu_maps_update_begin();
477 cpu_hotplug_begin();
478
479
480 arch_unregister_cpu(pr->id);
481 acpi_unmap_cpu(pr->id);
482
483 cpu_hotplug_done();
484 cpu_maps_update_done();
485
486 try_offline_node(cpu_to_node(pr->id));
487
488 out:
489 free_cpumask_var(pr->throttling.shared_cpu_map);
490 kfree(pr);
491}
492#endif
493
494
495
496
497
498static const struct acpi_device_id processor_device_ids[] = {
499
500 { ACPI_PROCESSOR_OBJECT_HID, },
501 { ACPI_PROCESSOR_DEVICE_HID, },
502
503 { }
504};
505
506static struct acpi_scan_handler processor_handler = {
507 .ids = processor_device_ids,
508 .attach = acpi_processor_add,
509#ifdef CONFIG_ACPI_HOTPLUG_CPU
510 .detach = acpi_processor_remove,
511#endif
512 .hotplug = {
513 .enabled = true,
514 },
515};
516
517void __init acpi_processor_init(void)
518{
519 acpi_scan_add_handler_with_hotplug(&processor_handler, "processor");
520}
521