hwsleep.c 16.9 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8

/******************************************************************************
 *
 * Name: hwsleep.c - ACPI Hardware Sleep/Wake Interface
 *
 *****************************************************************************/

/*
B
Bob Moore 已提交
9
 * Copyright (C) 2000 - 2007, R. Byron Moore
L
Linus Torvalds 已提交
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
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions, and the following disclaimer,
 *    without modification.
 * 2. Redistributions in binary form must reproduce at minimum a disclaimer
 *    substantially similar to the "NO WARRANTY" disclaimer below
 *    ("Disclaimer") and any redistribution must be conditioned upon
 *    including a substantially similar Disclaimer requirement for further
 *    binary redistribution.
 * 3. Neither the names of the above-listed copyright holders nor the names
 *    of any contributors may be used to endorse or promote products derived
 *    from this software without specific prior written permission.
 *
 * Alternatively, this software may be distributed under the terms of the
 * GNU General Public License ("GPL") version 2 as published by the Free
 * Software Foundation.
 *
 * NO WARRANTY
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGES.
 */

#include <acpi/acpi.h>
46
#include <acpi/actables.h>
L
Linus Torvalds 已提交
47 48

#define _COMPONENT          ACPI_HARDWARE
L
Len Brown 已提交
49
ACPI_MODULE_NAME("hwsleep")
L
Linus Torvalds 已提交
50

R
Robert Moore 已提交
51
/*******************************************************************************
L
Linus Torvalds 已提交
52 53 54 55 56 57 58 59
 *
 * FUNCTION:    acpi_set_firmware_waking_vector
 *
 * PARAMETERS:  physical_address    - Physical address of ACPI real mode
 *                                    entry point.
 *
 * RETURN:      Status
 *
R
Robert Moore 已提交
60
 * DESCRIPTION: Access function for the firmware_waking_vector field in FACS
L
Linus Torvalds 已提交
61 62 63
 *
 ******************************************************************************/
acpi_status
L
Len Brown 已提交
64
acpi_set_firmware_waking_vector(acpi_physical_address physical_address)
L
Linus Torvalds 已提交
65
{
66 67
	struct acpi_table_facs *facs;
	acpi_status status;
L
Linus Torvalds 已提交
68

B
Bob Moore 已提交
69
	ACPI_FUNCTION_TRACE(acpi_set_firmware_waking_vector);
L
Linus Torvalds 已提交
70

71 72 73 74 75 76 77 78 79
	/* Get the FACS */

	status =
	    acpi_get_table_by_index(ACPI_TABLE_INDEX_FACS,
				    (struct acpi_table_header **)&facs);
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
	}

L
Linus Torvalds 已提交
80 81
	/* Set the vector */

82 83 84 85 86
	if ((facs->length < 32) || (!(facs->xfirmware_waking_vector))) {
		/*
		 * ACPI 1.0 FACS or short table or optional X_ field is zero
		 */
		facs->firmware_waking_vector = (u32) physical_address;
L
Len Brown 已提交
87
	} else {
88 89 90 91
		/*
		 * ACPI 2.0 FACS with valid X_ field
		 */
		facs->xfirmware_waking_vector = physical_address;
L
Linus Torvalds 已提交
92 93
	}

L
Len Brown 已提交
94
	return_ACPI_STATUS(AE_OK);
L
Linus Torvalds 已提交
95 96
}

B
Bob Moore 已提交
97 98
ACPI_EXPORT_SYMBOL(acpi_set_firmware_waking_vector)

R
Robert Moore 已提交
99
/*******************************************************************************
L
Linus Torvalds 已提交
100 101 102
 *
 * FUNCTION:    acpi_get_firmware_waking_vector
 *
R
Robert Moore 已提交
103
 * PARAMETERS:  *physical_address   - Where the contents of
L
Linus Torvalds 已提交
104
 *                                    the firmware_waking_vector field of
R
Robert Moore 已提交
105
 *                                    the FACS will be returned.
L
Linus Torvalds 已提交
106
 *
R
Robert Moore 已提交
107
 * RETURN:      Status, vector
L
Linus Torvalds 已提交
108
 *
R
Robert Moore 已提交
109
 * DESCRIPTION: Access function for the firmware_waking_vector field in FACS
L
Linus Torvalds 已提交
110 111 112 113
 *
 ******************************************************************************/
#ifdef ACPI_FUTURE_USAGE
acpi_status
L
Len Brown 已提交
114
acpi_get_firmware_waking_vector(acpi_physical_address * physical_address)
L
Linus Torvalds 已提交
115
{
116 117
	struct acpi_table_facs *facs;
	acpi_status status;
L
Linus Torvalds 已提交
118

B
Bob Moore 已提交
119
	ACPI_FUNCTION_TRACE(acpi_get_firmware_waking_vector);
L
Linus Torvalds 已提交
120 121

	if (!physical_address) {
L
Len Brown 已提交
122
		return_ACPI_STATUS(AE_BAD_PARAMETER);
L
Linus Torvalds 已提交
123 124
	}

125 126 127 128 129 130 131 132 133
	/* Get the FACS */

	status =
	    acpi_get_table_by_index(ACPI_TABLE_INDEX_FACS,
				    (struct acpi_table_header **)&facs);
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
	}

L
Linus Torvalds 已提交
134 135
	/* Get the vector */

136 137 138 139 140 141
	if ((facs->length < 32) || (!(facs->xfirmware_waking_vector))) {
		/*
		 * ACPI 1.0 FACS or short table or optional X_ field is zero
		 */
		*physical_address =
		    (acpi_physical_address) facs->firmware_waking_vector;
L
Len Brown 已提交
142
	} else {
143 144 145
		/*
		 * ACPI 2.0 FACS with valid X_ field
		 */
L
Linus Torvalds 已提交
146
		*physical_address =
147
		    (acpi_physical_address) facs->xfirmware_waking_vector;
L
Linus Torvalds 已提交
148 149
	}

L
Len Brown 已提交
150
	return_ACPI_STATUS(AE_OK);
L
Linus Torvalds 已提交
151
}
B
Bob Moore 已提交
152 153

ACPI_EXPORT_SYMBOL(acpi_get_firmware_waking_vector)
L
Linus Torvalds 已提交
154
#endif
R
Robert Moore 已提交
155
/*******************************************************************************
L
Linus Torvalds 已提交
156 157 158 159 160 161 162 163 164 165 166 167 168
 *
 * FUNCTION:    acpi_enter_sleep_state_prep
 *
 * PARAMETERS:  sleep_state         - Which sleep state to enter
 *
 * RETURN:      Status
 *
 * DESCRIPTION: Prepare to enter a system sleep state (see ACPI 2.0 spec p 231)
 *              This function must execute with interrupts enabled.
 *              We break sleeping into 2 stages so that OSPM can handle
 *              various OS-specific tasks between the two steps.
 *
 ******************************************************************************/
L
Len Brown 已提交
169
acpi_status acpi_enter_sleep_state_prep(u8 sleep_state)
L
Linus Torvalds 已提交
170
{
L
Len Brown 已提交
171 172 173
	acpi_status status;
	struct acpi_object_list arg_list;
	union acpi_object arg;
L
Linus Torvalds 已提交
174

B
Bob Moore 已提交
175
	ACPI_FUNCTION_TRACE(acpi_enter_sleep_state_prep);
L
Linus Torvalds 已提交
176 177 178 179

	/*
	 * _PSW methods could be run here to enable wake-on keyboard, LAN, etc.
	 */
L
Len Brown 已提交
180 181 182 183 184
	status = acpi_get_sleep_type_data(sleep_state,
					  &acpi_gbl_sleep_type_a,
					  &acpi_gbl_sleep_type_b);
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
185 186 187 188 189 190 191 192 193 194 195 196
	}

	/* Setup parameter object */

	arg_list.count = 1;
	arg_list.pointer = &arg;

	arg.type = ACPI_TYPE_INTEGER;
	arg.integer.value = sleep_state;

	/* Run the _PTS and _GTS methods */

L
Len Brown 已提交
197 198 199
	status = acpi_evaluate_object(NULL, METHOD_NAME__PTS, &arg_list, NULL);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
200 201
	}

L
Len Brown 已提交
202 203 204
	status = acpi_evaluate_object(NULL, METHOD_NAME__GTS, &arg_list, NULL);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224
	}

	/* Setup the argument to _SST */

	switch (sleep_state) {
	case ACPI_STATE_S0:
		arg.integer.value = ACPI_SST_WORKING;
		break;

	case ACPI_STATE_S1:
	case ACPI_STATE_S2:
	case ACPI_STATE_S3:
		arg.integer.value = ACPI_SST_SLEEPING;
		break;

	case ACPI_STATE_S4:
		arg.integer.value = ACPI_SST_SLEEP_CONTEXT;
		break;

	default:
L
Len Brown 已提交
225
		arg.integer.value = ACPI_SST_INDICATOR_OFF;	/* Default is off */
L
Linus Torvalds 已提交
226 227 228 229 230
		break;
	}

	/* Set the system indicators to show the desired sleep state. */

L
Len Brown 已提交
231 232
	status = acpi_evaluate_object(NULL, METHOD_NAME__SST, &arg_list, NULL);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
B
Bob Moore 已提交
233 234
		ACPI_EXCEPTION((AE_INFO, status,
				"While executing method _SST"));
L
Linus Torvalds 已提交
235 236
	}

237 238 239 240 241 242 243 244
	/*
	 * 1) Disable/Clear all GPEs
	 */
	status = acpi_hw_disable_all_gpes();
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
	}

L
Len Brown 已提交
245
	return_ACPI_STATUS(AE_OK);
L
Linus Torvalds 已提交
246 247
}

B
Bob Moore 已提交
248 249
ACPI_EXPORT_SYMBOL(acpi_enter_sleep_state_prep)

R
Robert Moore 已提交
250
/*******************************************************************************
L
Linus Torvalds 已提交
251 252 253 254 255 256 257 258 259 260 261
 *
 * FUNCTION:    acpi_enter_sleep_state
 *
 * PARAMETERS:  sleep_state         - Which sleep state to enter
 *
 * RETURN:      Status
 *
 * DESCRIPTION: Enter a system sleep state (see ACPI 2.0 spec p 231)
 *              THIS FUNCTION MUST BE CALLED WITH INTERRUPTS DISABLED
 *
 ******************************************************************************/
L
Len Brown 已提交
262
acpi_status asmlinkage acpi_enter_sleep_state(u8 sleep_state)
L
Linus Torvalds 已提交
263
{
L
Len Brown 已提交
264 265 266 267 268 269
	u32 PM1Acontrol;
	u32 PM1Bcontrol;
	struct acpi_bit_register_info *sleep_type_reg_info;
	struct acpi_bit_register_info *sleep_enable_reg_info;
	u32 in_value;
	acpi_status status;
L
Linus Torvalds 已提交
270

B
Bob Moore 已提交
271
	ACPI_FUNCTION_TRACE(acpi_enter_sleep_state);
L
Linus Torvalds 已提交
272 273

	if ((acpi_gbl_sleep_type_a > ACPI_SLEEP_TYPE_MAX) ||
L
Len Brown 已提交
274
	    (acpi_gbl_sleep_type_b > ACPI_SLEEP_TYPE_MAX)) {
B
Bob Moore 已提交
275 276
		ACPI_ERROR((AE_INFO, "Sleep values out of range: A=%X B=%X",
			    acpi_gbl_sleep_type_a, acpi_gbl_sleep_type_b));
L
Len Brown 已提交
277
		return_ACPI_STATUS(AE_AML_OPERAND_VALUE);
L
Linus Torvalds 已提交
278 279
	}

L
Len Brown 已提交
280 281 282 283
	sleep_type_reg_info =
	    acpi_hw_get_bit_register_info(ACPI_BITREG_SLEEP_TYPE_A);
	sleep_enable_reg_info =
	    acpi_hw_get_bit_register_info(ACPI_BITREG_SLEEP_ENABLE);
L
Linus Torvalds 已提交
284 285 286

	/* Clear wake status */

287
	status = acpi_set_register(ACPI_BITREG_WAKE_STATUS, 1);
L
Len Brown 已提交
288 289
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
290 291 292 293
	}

	/* Clear all fixed and general purpose status bits */

294
	status = acpi_hw_clear_acpi_status();
L
Len Brown 已提交
295 296
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
297 298 299 300 301
	}

	/*
	 * 2) Enable all wakeup GPEs
	 */
302 303 304 305 306
	status = acpi_hw_disable_all_gpes();
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
	}

L
Linus Torvalds 已提交
307 308
	acpi_gbl_system_awake_and_running = FALSE;

L
Len Brown 已提交
309 310 311
	status = acpi_hw_enable_all_wakeup_gpes();
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
312 313 314 315
	}

	/* Get current value of PM1A control */

L
Len Brown 已提交
316 317 318 319
	status = acpi_hw_register_read(ACPI_MTX_DO_NOT_LOCK,
				       ACPI_REGISTER_PM1_CONTROL, &PM1Acontrol);
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
320
	}
L
Len Brown 已提交
321 322
	ACPI_DEBUG_PRINT((ACPI_DB_INIT,
			  "Entering sleep state [S%d]\n", sleep_state));
L
Linus Torvalds 已提交
323 324 325

	/* Clear SLP_EN and SLP_TYP fields */

R
Robert Moore 已提交
326
	PM1Acontrol &= ~(sleep_type_reg_info->access_bit_mask |
L
Len Brown 已提交
327
			 sleep_enable_reg_info->access_bit_mask);
L
Linus Torvalds 已提交
328 329 330 331
	PM1Bcontrol = PM1Acontrol;

	/* Insert SLP_TYP bits */

L
Len Brown 已提交
332 333 334 335
	PM1Acontrol |=
	    (acpi_gbl_sleep_type_a << sleep_type_reg_info->bit_position);
	PM1Bcontrol |=
	    (acpi_gbl_sleep_type_b << sleep_type_reg_info->bit_position);
L
Linus Torvalds 已提交
336 337 338 339 340 341 342 343

	/*
	 * We split the writes of SLP_TYP and SLP_EN to workaround
	 * poorly implemented hardware.
	 */

	/* Write #1: fill in SLP_TYP data */

L
Len Brown 已提交
344 345 346 347 348
	status = acpi_hw_register_write(ACPI_MTX_DO_NOT_LOCK,
					ACPI_REGISTER_PM1A_CONTROL,
					PM1Acontrol);
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
349 350
	}

L
Len Brown 已提交
351 352 353 354 355
	status = acpi_hw_register_write(ACPI_MTX_DO_NOT_LOCK,
					ACPI_REGISTER_PM1B_CONTROL,
					PM1Bcontrol);
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
356 357 358 359 360 361 362 363 364
	}

	/* Insert SLP_ENABLE bit */

	PM1Acontrol |= sleep_enable_reg_info->access_bit_mask;
	PM1Bcontrol |= sleep_enable_reg_info->access_bit_mask;

	/* Write #2: SLP_TYP + SLP_EN */

L
Len Brown 已提交
365
	ACPI_FLUSH_CPU_CACHE();
L
Linus Torvalds 已提交
366

L
Len Brown 已提交
367 368 369 370 371
	status = acpi_hw_register_write(ACPI_MTX_DO_NOT_LOCK,
					ACPI_REGISTER_PM1A_CONTROL,
					PM1Acontrol);
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
372 373
	}

L
Len Brown 已提交
374 375 376 377 378
	status = acpi_hw_register_write(ACPI_MTX_DO_NOT_LOCK,
					ACPI_REGISTER_PM1B_CONTROL,
					PM1Bcontrol);
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
379 380 381 382
	}

	if (sleep_state > ACPI_STATE_S3) {
		/*
R
Robert Moore 已提交
383 384
		 * We wanted to sleep > S3, but it didn't happen (by virtue of the
		 * fact that we are still executing!)
L
Linus Torvalds 已提交
385
		 *
R
Robert Moore 已提交
386 387
		 * Wait ten seconds, then try again. This is to get S4/S5 to work on
		 * all machines.
L
Linus Torvalds 已提交
388 389 390 391 392
		 *
		 * We wait so long to allow chipsets that poll this reg very slowly to
		 * still read the right value. Ideally, this block would go
		 * away entirely.
		 */
L
Len Brown 已提交
393 394 395 396 397 398 399 400
		acpi_os_stall(10000000);

		status = acpi_hw_register_write(ACPI_MTX_DO_NOT_LOCK,
						ACPI_REGISTER_PM1_CONTROL,
						sleep_enable_reg_info->
						access_bit_mask);
		if (ACPI_FAILURE(status)) {
			return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
401 402 403 404 405 406
		}
	}

	/* Wait until we enter sleep state */

	do {
407
		status = acpi_get_register(ACPI_BITREG_WAKE_STATUS, &in_value);
L
Len Brown 已提交
408 409
		if (ACPI_FAILURE(status)) {
			return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
410 411 412 413 414 415
		}

		/* Spin until we wake */

	} while (!in_value);

L
Len Brown 已提交
416
	return_ACPI_STATUS(AE_OK);
L
Linus Torvalds 已提交
417 418
}

B
Bob Moore 已提交
419
ACPI_EXPORT_SYMBOL(acpi_enter_sleep_state)
L
Linus Torvalds 已提交
420

R
Robert Moore 已提交
421
/*******************************************************************************
L
Linus Torvalds 已提交
422 423 424 425 426 427 428 429 430 431 432
 *
 * FUNCTION:    acpi_enter_sleep_state_s4bios
 *
 * PARAMETERS:  None
 *
 * RETURN:      Status
 *
 * DESCRIPTION: Perform a S4 bios request.
 *              THIS FUNCTION MUST BE CALLED WITH INTERRUPTS DISABLED
 *
 ******************************************************************************/
L
Len Brown 已提交
433
acpi_status asmlinkage acpi_enter_sleep_state_s4bios(void)
L
Linus Torvalds 已提交
434
{
L
Len Brown 已提交
435 436
	u32 in_value;
	acpi_status status;
L
Linus Torvalds 已提交
437

B
Bob Moore 已提交
438
	ACPI_FUNCTION_TRACE(acpi_enter_sleep_state_s4bios);
L
Linus Torvalds 已提交
439

440
	status = acpi_set_register(ACPI_BITREG_WAKE_STATUS, 1);
L
Len Brown 已提交
441 442
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
443 444
	}

445
	status = acpi_hw_clear_acpi_status();
L
Len Brown 已提交
446 447
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
448 449 450 451 452 453
	}

	/*
	 * 1) Disable/Clear all GPEs
	 * 2) Enable all wakeup GPEs
	 */
L
Len Brown 已提交
454 455 456
	status = acpi_hw_disable_all_gpes();
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
457 458 459
	}
	acpi_gbl_system_awake_and_running = FALSE;

L
Len Brown 已提交
460 461 462
	status = acpi_hw_enable_all_wakeup_gpes();
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
463 464
	}

L
Len Brown 已提交
465
	ACPI_FLUSH_CPU_CACHE();
L
Linus Torvalds 已提交
466

467 468
	status = acpi_os_write_port(acpi_gbl_FADT.smi_command,
				    (u32) acpi_gbl_FADT.S4bios_request, 8);
L
Linus Torvalds 已提交
469 470 471

	do {
		acpi_os_stall(1000);
472
		status = acpi_get_register(ACPI_BITREG_WAKE_STATUS, &in_value);
L
Len Brown 已提交
473 474
		if (ACPI_FAILURE(status)) {
			return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
475 476 477
		}
	} while (!in_value);

L
Len Brown 已提交
478
	return_ACPI_STATUS(AE_OK);
L
Linus Torvalds 已提交
479 480
}

B
Bob Moore 已提交
481
ACPI_EXPORT_SYMBOL(acpi_enter_sleep_state_s4bios)
L
Linus Torvalds 已提交
482

R
Robert Moore 已提交
483
/*******************************************************************************
L
Linus Torvalds 已提交
484 485 486 487 488 489 490 491 492 493 494
 *
 * FUNCTION:    acpi_leave_sleep_state
 *
 * PARAMETERS:  sleep_state         - Which sleep state we just exited
 *
 * RETURN:      Status
 *
 * DESCRIPTION: Perform OS-independent ACPI cleanup after a sleep
 *              Called with interrupts ENABLED.
 *
 ******************************************************************************/
L
Len Brown 已提交
495
acpi_status acpi_leave_sleep_state(u8 sleep_state)
L
Linus Torvalds 已提交
496
{
L
Len Brown 已提交
497 498 499 500 501 502 503
	struct acpi_object_list arg_list;
	union acpi_object arg;
	acpi_status status;
	struct acpi_bit_register_info *sleep_type_reg_info;
	struct acpi_bit_register_info *sleep_enable_reg_info;
	u32 PM1Acontrol;
	u32 PM1Bcontrol;
L
Linus Torvalds 已提交
504

B
Bob Moore 已提交
505
	ACPI_FUNCTION_TRACE(acpi_leave_sleep_state);
L
Linus Torvalds 已提交
506 507 508 509 510 511

	/*
	 * Set SLP_TYPE and SLP_EN to state S0.
	 * This is unclear from the ACPI Spec, but it is required
	 * by some machines.
	 */
L
Len Brown 已提交
512 513 514 515 516 517 518 519
	status = acpi_get_sleep_type_data(ACPI_STATE_S0,
					  &acpi_gbl_sleep_type_a,
					  &acpi_gbl_sleep_type_b);
	if (ACPI_SUCCESS(status)) {
		sleep_type_reg_info =
		    acpi_hw_get_bit_register_info(ACPI_BITREG_SLEEP_TYPE_A);
		sleep_enable_reg_info =
		    acpi_hw_get_bit_register_info(ACPI_BITREG_SLEEP_ENABLE);
L
Linus Torvalds 已提交
520 521 522

		/* Get current value of PM1A control */

L
Len Brown 已提交
523 524 525 526
		status = acpi_hw_register_read(ACPI_MTX_DO_NOT_LOCK,
					       ACPI_REGISTER_PM1_CONTROL,
					       &PM1Acontrol);
		if (ACPI_SUCCESS(status)) {
B
Bob Moore 已提交
527

L
Linus Torvalds 已提交
528 529 530
			/* Clear SLP_EN and SLP_TYP fields */

			PM1Acontrol &= ~(sleep_type_reg_info->access_bit_mask |
L
Len Brown 已提交
531 532
					 sleep_enable_reg_info->
					 access_bit_mask);
L
Linus Torvalds 已提交
533 534 535 536
			PM1Bcontrol = PM1Acontrol;

			/* Insert SLP_TYP bits */

L
Len Brown 已提交
537 538 539 540 541 542
			PM1Acontrol |=
			    (acpi_gbl_sleep_type_a << sleep_type_reg_info->
			     bit_position);
			PM1Bcontrol |=
			    (acpi_gbl_sleep_type_b << sleep_type_reg_info->
			     bit_position);
L
Linus Torvalds 已提交
543 544 545

			/* Just ignore any errors */

L
Len Brown 已提交
546 547 548 549 550 551
			(void)acpi_hw_register_write(ACPI_MTX_DO_NOT_LOCK,
						     ACPI_REGISTER_PM1A_CONTROL,
						     PM1Acontrol);
			(void)acpi_hw_register_write(ACPI_MTX_DO_NOT_LOCK,
						     ACPI_REGISTER_PM1B_CONTROL,
						     PM1Bcontrol);
L
Linus Torvalds 已提交
552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567
		}
	}

	/* Ensure enter_sleep_state_prep -> enter_sleep_state ordering */

	acpi_gbl_sleep_type_a = ACPI_SLEEP_TYPE_INVALID;

	/* Setup parameter object */

	arg_list.count = 1;
	arg_list.pointer = &arg;
	arg.type = ACPI_TYPE_INTEGER;

	/* Ignore any errors from these methods */

	arg.integer.value = ACPI_SST_WAKING;
L
Len Brown 已提交
568 569
	status = acpi_evaluate_object(NULL, METHOD_NAME__SST, &arg_list, NULL);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
B
Bob Moore 已提交
570
		ACPI_EXCEPTION((AE_INFO, status, "During Method _SST"));
L
Linus Torvalds 已提交
571 572 573
	}

	arg.integer.value = sleep_state;
L
Len Brown 已提交
574 575
	status = acpi_evaluate_object(NULL, METHOD_NAME__BFS, &arg_list, NULL);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
B
Bob Moore 已提交
576
		ACPI_EXCEPTION((AE_INFO, status, "During Method _BFS"));
L
Linus Torvalds 已提交
577 578
	}

L
Len Brown 已提交
579 580
	status = acpi_evaluate_object(NULL, METHOD_NAME__WAK, &arg_list, NULL);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
B
Bob Moore 已提交
581
		ACPI_EXCEPTION((AE_INFO, status, "During Method _WAK"));
L
Linus Torvalds 已提交
582 583 584 585 586 587 588 589
	}
	/* TBD: _WAK "sometimes" returns stuff - do we want to look at it? */

	/*
	 * Restore the GPEs:
	 * 1) Disable/Clear all GPEs
	 * 2) Enable all runtime GPEs
	 */
L
Len Brown 已提交
590 591 592
	status = acpi_hw_disable_all_gpes();
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
593 594 595
	}
	acpi_gbl_system_awake_and_running = TRUE;

L
Len Brown 已提交
596 597 598
	status = acpi_hw_enable_all_runtime_gpes();
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
599 600 601 602
	}

	/* Enable power button */

L
Len Brown 已提交
603 604
	(void)
	    acpi_set_register(acpi_gbl_fixed_event_info
605
			      [ACPI_EVENT_POWER_BUTTON].enable_register_id, 1);
R
Robert Moore 已提交
606

L
Len Brown 已提交
607 608
	(void)
	    acpi_set_register(acpi_gbl_fixed_event_info
609
			      [ACPI_EVENT_POWER_BUTTON].status_register_id, 1);
L
Linus Torvalds 已提交
610 611

	arg.integer.value = ACPI_SST_WORKING;
L
Len Brown 已提交
612 613
	status = acpi_evaluate_object(NULL, METHOD_NAME__SST, &arg_list, NULL);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
B
Bob Moore 已提交
614
		ACPI_EXCEPTION((AE_INFO, status, "During Method _SST"));
L
Linus Torvalds 已提交
615 616
	}

L
Len Brown 已提交
617
	return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
618
}
B
Bob Moore 已提交
619 620

ACPI_EXPORT_SYMBOL(acpi_leave_sleep_state)