hwsleep.c 17.0 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 - 2006, 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 155
#endif

R
Robert Moore 已提交
156
/*******************************************************************************
L
Linus Torvalds 已提交
157 158 159 160 161 162 163 164 165 166 167 168 169
 *
 * 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 已提交
170
acpi_status acpi_enter_sleep_state_prep(u8 sleep_state)
L
Linus Torvalds 已提交
171
{
L
Len Brown 已提交
172 173 174
	acpi_status status;
	struct acpi_object_list arg_list;
	union acpi_object arg;
L
Linus Torvalds 已提交
175

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

	/*
	 * _PSW methods could be run here to enable wake-on keyboard, LAN, etc.
	 */
L
Len Brown 已提交
181 182 183 184 185
	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 已提交
186 187 188 189 190 191 192 193 194 195 196 197
	}

	/* 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 已提交
198 199 200
	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 已提交
201 202
	}

L
Len Brown 已提交
203 204 205
	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 已提交
206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225
	}

	/* 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 已提交
226
		arg.integer.value = ACPI_SST_INDICATOR_OFF;	/* Default is off */
L
Linus Torvalds 已提交
227 228 229 230 231
		break;
	}

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

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

L
Len Brown 已提交
238
	return_ACPI_STATUS(AE_OK);
L
Linus Torvalds 已提交
239 240
}

B
Bob Moore 已提交
241 242
ACPI_EXPORT_SYMBOL(acpi_enter_sleep_state_prep)

R
Robert Moore 已提交
243
/*******************************************************************************
L
Linus Torvalds 已提交
244 245 246 247 248 249 250 251 252 253 254
 *
 * 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 已提交
255
acpi_status asmlinkage acpi_enter_sleep_state(u8 sleep_state)
L
Linus Torvalds 已提交
256
{
L
Len Brown 已提交
257 258 259 260 261 262
	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 已提交
263

B
Bob Moore 已提交
264
	ACPI_FUNCTION_TRACE(acpi_enter_sleep_state);
L
Linus Torvalds 已提交
265 266

	if ((acpi_gbl_sleep_type_a > ACPI_SLEEP_TYPE_MAX) ||
L
Len Brown 已提交
267
	    (acpi_gbl_sleep_type_b > ACPI_SLEEP_TYPE_MAX)) {
B
Bob Moore 已提交
268 269
		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 已提交
270
		return_ACPI_STATUS(AE_AML_OPERAND_VALUE);
L
Linus Torvalds 已提交
271 272
	}

L
Len Brown 已提交
273 274 275 276
	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 已提交
277 278 279

	/* Clear wake status */

L
Len Brown 已提交
280 281 282 283
	status =
	    acpi_set_register(ACPI_BITREG_WAKE_STATUS, 1, ACPI_MTX_DO_NOT_LOCK);
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
284 285 286 287
	}

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

L
Len Brown 已提交
288 289 290
	status = acpi_hw_clear_acpi_status(ACPI_MTX_DO_NOT_LOCK);
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
291 292 293 294 295 296
	}

	/*
	 * 1) Disable/Clear all GPEs
	 * 2) Enable all wakeup GPEs
	 */
L
Len Brown 已提交
297 298 299
	status = acpi_hw_disable_all_gpes();
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
300 301 302
	}
	acpi_gbl_system_awake_and_running = FALSE;

L
Len Brown 已提交
303 304 305
	status = acpi_hw_enable_all_wakeup_gpes();
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
306 307 308 309
	}

	/* Get current value of PM1A control */

L
Len Brown 已提交
310 311 312 313
	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 已提交
314
	}
L
Len Brown 已提交
315 316
	ACPI_DEBUG_PRINT((ACPI_DB_INIT,
			  "Entering sleep state [S%d]\n", sleep_state));
L
Linus Torvalds 已提交
317 318 319

	/* Clear SLP_EN and SLP_TYP fields */

R
Robert Moore 已提交
320
	PM1Acontrol &= ~(sleep_type_reg_info->access_bit_mask |
L
Len Brown 已提交
321
			 sleep_enable_reg_info->access_bit_mask);
L
Linus Torvalds 已提交
322 323 324 325
	PM1Bcontrol = PM1Acontrol;

	/* Insert SLP_TYP bits */

L
Len Brown 已提交
326 327 328 329
	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 已提交
330 331 332 333 334 335 336 337

	/*
	 * 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 已提交
338 339 340 341 342
	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 已提交
343 344
	}

L
Len Brown 已提交
345 346 347 348 349
	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 已提交
350 351 352 353 354 355 356 357 358
	}

	/* 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 已提交
359
	ACPI_FLUSH_CPU_CACHE();
L
Linus Torvalds 已提交
360

L
Len Brown 已提交
361 362 363 364 365
	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 已提交
366 367
	}

L
Len Brown 已提交
368 369 370 371 372
	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 已提交
373 374 375 376
	}

	if (sleep_state > ACPI_STATE_S3) {
		/*
R
Robert Moore 已提交
377 378
		 * We wanted to sleep > S3, but it didn't happen (by virtue of the
		 * fact that we are still executing!)
L
Linus Torvalds 已提交
379
		 *
R
Robert Moore 已提交
380 381
		 * Wait ten seconds, then try again. This is to get S4/S5 to work on
		 * all machines.
L
Linus Torvalds 已提交
382 383 384 385 386
		 *
		 * 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 已提交
387 388 389 390 391 392 393 394
		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 已提交
395 396 397 398 399 400
		}
	}

	/* Wait until we enter sleep state */

	do {
L
Len Brown 已提交
401 402 403 404
		status = acpi_get_register(ACPI_BITREG_WAKE_STATUS, &in_value,
					   ACPI_MTX_DO_NOT_LOCK);
		if (ACPI_FAILURE(status)) {
			return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
405 406 407 408 409 410
		}

		/* Spin until we wake */

	} while (!in_value);

L
Len Brown 已提交
411
	return_ACPI_STATUS(AE_OK);
L
Linus Torvalds 已提交
412 413
}

B
Bob Moore 已提交
414
ACPI_EXPORT_SYMBOL(acpi_enter_sleep_state)
L
Linus Torvalds 已提交
415

R
Robert Moore 已提交
416
/*******************************************************************************
L
Linus Torvalds 已提交
417 418 419 420 421 422 423 424 425 426 427
 *
 * 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 已提交
428
acpi_status asmlinkage acpi_enter_sleep_state_s4bios(void)
L
Linus Torvalds 已提交
429
{
L
Len Brown 已提交
430 431
	u32 in_value;
	acpi_status status;
L
Linus Torvalds 已提交
432

B
Bob Moore 已提交
433
	ACPI_FUNCTION_TRACE(acpi_enter_sleep_state_s4bios);
L
Linus Torvalds 已提交
434

L
Len Brown 已提交
435 436 437 438
	status =
	    acpi_set_register(ACPI_BITREG_WAKE_STATUS, 1, ACPI_MTX_DO_NOT_LOCK);
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
439 440
	}

L
Len Brown 已提交
441 442 443
	status = acpi_hw_clear_acpi_status(ACPI_MTX_DO_NOT_LOCK);
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
444 445 446 447 448 449
	}

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

L
Len Brown 已提交
456 457 458
	status = acpi_hw_enable_all_wakeup_gpes();
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
459 460
	}

L
Len Brown 已提交
461
	ACPI_FLUSH_CPU_CACHE();
L
Linus Torvalds 已提交
462

463 464
	status = acpi_os_write_port(acpi_gbl_FADT.smi_command,
				    (u32) acpi_gbl_FADT.S4bios_request, 8);
L
Linus Torvalds 已提交
465 466 467

	do {
		acpi_os_stall(1000);
L
Len Brown 已提交
468 469 470 471
		status = acpi_get_register(ACPI_BITREG_WAKE_STATUS, &in_value,
					   ACPI_MTX_DO_NOT_LOCK);
		if (ACPI_FAILURE(status)) {
			return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
472 473 474
		}
	} while (!in_value);

L
Len Brown 已提交
475
	return_ACPI_STATUS(AE_OK);
L
Linus Torvalds 已提交
476 477
}

B
Bob Moore 已提交
478
ACPI_EXPORT_SYMBOL(acpi_enter_sleep_state_s4bios)
L
Linus Torvalds 已提交
479

R
Robert Moore 已提交
480
/*******************************************************************************
L
Linus Torvalds 已提交
481 482 483 484 485 486 487 488 489 490 491
 *
 * 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 已提交
492
acpi_status acpi_leave_sleep_state(u8 sleep_state)
L
Linus Torvalds 已提交
493
{
L
Len Brown 已提交
494 495 496 497 498 499 500
	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 已提交
501

B
Bob Moore 已提交
502
	ACPI_FUNCTION_TRACE(acpi_leave_sleep_state);
L
Linus Torvalds 已提交
503 504 505 506 507 508

	/*
	 * 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 已提交
509 510 511 512 513 514 515 516
	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 已提交
517 518 519

		/* Get current value of PM1A control */

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

L
Linus Torvalds 已提交
525 526 527
			/* Clear SLP_EN and SLP_TYP fields */

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

			/* Insert SLP_TYP bits */

L
Len Brown 已提交
534 535 536 537 538 539
			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 已提交
540 541 542

			/* Just ignore any errors */

L
Len Brown 已提交
543 544 545 546 547 548
			(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 已提交
549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564
		}
	}

	/* 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 已提交
565 566
	status = acpi_evaluate_object(NULL, METHOD_NAME__SST, &arg_list, NULL);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
B
Bob Moore 已提交
567
		ACPI_EXCEPTION((AE_INFO, status, "During Method _SST"));
L
Linus Torvalds 已提交
568 569 570
	}

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

L
Len Brown 已提交
576 577
	status = acpi_evaluate_object(NULL, METHOD_NAME__WAK, &arg_list, NULL);
	if (ACPI_FAILURE(status) && status != AE_NOT_FOUND) {
B
Bob Moore 已提交
578
		ACPI_EXCEPTION((AE_INFO, status, "During Method _WAK"));
L
Linus Torvalds 已提交
579 580 581 582 583 584 585 586
	}
	/* 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 已提交
587 588 589
	status = acpi_hw_disable_all_gpes();
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
590 591 592
	}
	acpi_gbl_system_awake_and_running = TRUE;

L
Len Brown 已提交
593 594 595
	status = acpi_hw_enable_all_runtime_gpes();
	if (ACPI_FAILURE(status)) {
		return_ACPI_STATUS(status);
L
Linus Torvalds 已提交
596 597 598 599
	}

	/* Enable power button */

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

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

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

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

ACPI_EXPORT_SYMBOL(acpi_leave_sleep_state)