diff options
| -rw-r--r-- | drivers/acpi/acpi_pad.c | 37 |
1 files changed, 20 insertions, 17 deletions
diff --git a/drivers/acpi/acpi_pad.c b/drivers/acpi/acpi_pad.c index 0d2cdb86158b..a7bd49f0f01f 100644 --- a/drivers/acpi/acpi_pad.c +++ b/drivers/acpi/acpi_pad.c | |||
| @@ -207,7 +207,7 @@ static int power_saving_thread(void *data) | |||
| 207 | * the mechanism only works when all CPUs have RT task running, | 207 | * the mechanism only works when all CPUs have RT task running, |
| 208 | * as if one CPU hasn't RT task, RT task from other CPUs will | 208 | * as if one CPU hasn't RT task, RT task from other CPUs will |
| 209 | * borrow CPU time from this CPU and cause RT task use > 95% | 209 | * borrow CPU time from this CPU and cause RT task use > 95% |
| 210 | * CPU time. To make 'avoid staration' work, takes a nap here. | 210 | * CPU time. To make 'avoid starvation' work, takes a nap here. |
| 211 | */ | 211 | */ |
| 212 | if (do_sleep) | 212 | if (do_sleep) |
| 213 | schedule_timeout_killable(HZ * idle_pct / 100); | 213 | schedule_timeout_killable(HZ * idle_pct / 100); |
| @@ -221,14 +221,18 @@ static struct task_struct *ps_tsks[NR_CPUS]; | |||
| 221 | static unsigned int ps_tsk_num; | 221 | static unsigned int ps_tsk_num; |
| 222 | static int create_power_saving_task(void) | 222 | static int create_power_saving_task(void) |
| 223 | { | 223 | { |
| 224 | int rc = -ENOMEM; | ||
| 225 | |||
| 224 | ps_tsks[ps_tsk_num] = kthread_run(power_saving_thread, | 226 | ps_tsks[ps_tsk_num] = kthread_run(power_saving_thread, |
| 225 | (void *)(unsigned long)ps_tsk_num, | 227 | (void *)(unsigned long)ps_tsk_num, |
| 226 | "power_saving/%d", ps_tsk_num); | 228 | "power_saving/%d", ps_tsk_num); |
| 227 | if (ps_tsks[ps_tsk_num]) { | 229 | rc = IS_ERR(ps_tsks[ps_tsk_num]) ? PTR_ERR(ps_tsks[ps_tsk_num]) : 0; |
| 230 | if (!rc) | ||
| 228 | ps_tsk_num++; | 231 | ps_tsk_num++; |
| 229 | return 0; | 232 | else |
| 230 | } | 233 | ps_tsks[ps_tsk_num] = NULL; |
| 231 | return -EINVAL; | 234 | |
| 235 | return rc; | ||
| 232 | } | 236 | } |
| 233 | 237 | ||
| 234 | static void destroy_power_saving_task(void) | 238 | static void destroy_power_saving_task(void) |
| @@ -236,6 +240,7 @@ static void destroy_power_saving_task(void) | |||
| 236 | if (ps_tsk_num > 0) { | 240 | if (ps_tsk_num > 0) { |
| 237 | ps_tsk_num--; | 241 | ps_tsk_num--; |
| 238 | kthread_stop(ps_tsks[ps_tsk_num]); | 242 | kthread_stop(ps_tsks[ps_tsk_num]); |
| 243 | ps_tsks[ps_tsk_num] = NULL; | ||
| 239 | } | 244 | } |
| 240 | } | 245 | } |
| 241 | 246 | ||
| @@ -252,7 +257,7 @@ static void set_power_saving_task_num(unsigned int num) | |||
| 252 | } | 257 | } |
| 253 | } | 258 | } |
| 254 | 259 | ||
| 255 | static int acpi_pad_idle_cpus(unsigned int num_cpus) | 260 | static void acpi_pad_idle_cpus(unsigned int num_cpus) |
| 256 | { | 261 | { |
| 257 | get_online_cpus(); | 262 | get_online_cpus(); |
| 258 | 263 | ||
| @@ -260,7 +265,6 @@ static int acpi_pad_idle_cpus(unsigned int num_cpus) | |||
| 260 | set_power_saving_task_num(num_cpus); | 265 | set_power_saving_task_num(num_cpus); |
| 261 | 266 | ||
| 262 | put_online_cpus(); | 267 | put_online_cpus(); |
| 263 | return 0; | ||
| 264 | } | 268 | } |
| 265 | 269 | ||
| 266 | static uint32_t acpi_pad_idle_cpus_num(void) | 270 | static uint32_t acpi_pad_idle_cpus_num(void) |
| @@ -368,19 +372,21 @@ static void acpi_pad_remove_sysfs(struct acpi_device *device) | |||
| 368 | static int acpi_pad_pur(acpi_handle handle, int *num_cpus) | 372 | static int acpi_pad_pur(acpi_handle handle, int *num_cpus) |
| 369 | { | 373 | { |
| 370 | struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL}; | 374 | struct acpi_buffer buffer = {ACPI_ALLOCATE_BUFFER, NULL}; |
| 371 | acpi_status status; | ||
| 372 | union acpi_object *package; | 375 | union acpi_object *package; |
| 373 | int rev, num, ret = -EINVAL; | 376 | int rev, num, ret = -EINVAL; |
| 374 | 377 | ||
| 375 | status = acpi_evaluate_object(handle, "_PUR", NULL, &buffer); | 378 | if (ACPI_FAILURE(acpi_evaluate_object(handle, "_PUR", NULL, &buffer))) |
| 376 | if (ACPI_FAILURE(status)) | 379 | return -EINVAL; |
| 380 | |||
| 381 | if (!buffer.length || !buffer.pointer) | ||
| 377 | return -EINVAL; | 382 | return -EINVAL; |
| 383 | |||
| 378 | package = buffer.pointer; | 384 | package = buffer.pointer; |
| 379 | if (package->type != ACPI_TYPE_PACKAGE || package->package.count != 2) | 385 | if (package->type != ACPI_TYPE_PACKAGE || package->package.count != 2) |
| 380 | goto out; | 386 | goto out; |
| 381 | rev = package->package.elements[0].integer.value; | 387 | rev = package->package.elements[0].integer.value; |
| 382 | num = package->package.elements[1].integer.value; | 388 | num = package->package.elements[1].integer.value; |
| 383 | if (rev != 1) | 389 | if (rev != 1 || num < 0) |
| 384 | goto out; | 390 | goto out; |
| 385 | *num_cpus = num; | 391 | *num_cpus = num; |
| 386 | ret = 0; | 392 | ret = 0; |
| @@ -409,7 +415,7 @@ static void acpi_pad_ost(acpi_handle handle, int stat, | |||
| 409 | 415 | ||
| 410 | static void acpi_pad_handle_notify(acpi_handle handle) | 416 | static void acpi_pad_handle_notify(acpi_handle handle) |
| 411 | { | 417 | { |
| 412 | int num_cpus, ret; | 418 | int num_cpus; |
| 413 | uint32_t idle_cpus; | 419 | uint32_t idle_cpus; |
| 414 | 420 | ||
| 415 | mutex_lock(&isolated_cpus_lock); | 421 | mutex_lock(&isolated_cpus_lock); |
| @@ -417,12 +423,9 @@ static void acpi_pad_handle_notify(acpi_handle handle) | |||
| 417 | mutex_unlock(&isolated_cpus_lock); | 423 | mutex_unlock(&isolated_cpus_lock); |
| 418 | return; | 424 | return; |
| 419 | } | 425 | } |
| 420 | ret = acpi_pad_idle_cpus(num_cpus); | 426 | acpi_pad_idle_cpus(num_cpus); |
| 421 | idle_cpus = acpi_pad_idle_cpus_num(); | 427 | idle_cpus = acpi_pad_idle_cpus_num(); |
| 422 | if (!ret) | 428 | acpi_pad_ost(handle, 0, idle_cpus); |
| 423 | acpi_pad_ost(handle, 0, idle_cpus); | ||
| 424 | else | ||
| 425 | acpi_pad_ost(handle, 1, 0); | ||
| 426 | mutex_unlock(&isolated_cpus_lock); | 429 | mutex_unlock(&isolated_cpus_lock); |
| 427 | } | 430 | } |
| 428 | 431 | ||
