hwregs.c 23.3 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1 2 3 4 5 6 7 8 9

/*******************************************************************************
 *
 * Module Name: hwregs - Read/write access functions for the various ACPI
 *                       control and status registers.
 *
 ******************************************************************************/

/*
10
 * Copyright (C) 2000 - 2004, R. Byron Moore
11
 * All rights reserved.
Linus Torvalds's avatar
Linus Torvalds committed
12
 *
13 14 15 16 17 18 19 20 21 22 23 24 25 26
 * 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.
Linus Torvalds's avatar
Linus Torvalds committed
27
 *
28 29 30
 * 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.
Linus Torvalds's avatar
Linus Torvalds committed
31
 *
32 33 34 35 36 37 38 39 40 41 42 43
 * 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.
Linus Torvalds's avatar
Linus Torvalds committed
44 45 46
 */


47 48
#include <acpi/acpi.h>
#include <acpi/acnamesp.h>
49
#include <acpi/acevents.h>
Linus Torvalds's avatar
Linus Torvalds committed
50

Linus Torvalds's avatar
Linus Torvalds committed
51
#define _COMPONENT          ACPI_HARDWARE
Andy Grover's avatar
Andy Grover committed
52
	 ACPI_MODULE_NAME    ("hwregs")
Linus Torvalds's avatar
Linus Torvalds committed
53 54 55 56


/*******************************************************************************
 *
57
 * FUNCTION:    acpi_hw_clear_acpi_status
Linus Torvalds's avatar
Linus Torvalds committed
58
 *
59
 * PARAMETERS:  Flags           - Lock the hardware or not
Linus Torvalds's avatar
Linus Torvalds committed
60 61 62 63 64 65 66
 *
 * RETURN:      none
 *
 * DESCRIPTION: Clears all fixed and general purpose status bits
 *
 ******************************************************************************/

67
acpi_status
68 69
acpi_hw_clear_acpi_status (
	u32                             flags)
Linus Torvalds's avatar
Linus Torvalds committed
70
{
71
	acpi_status                     status;
Linus Torvalds's avatar
Linus Torvalds committed
72 73


74
	ACPI_FUNCTION_TRACE ("hw_clear_acpi_status");
Linus Torvalds's avatar
Linus Torvalds committed
75 76 77


	ACPI_DEBUG_PRINT ((ACPI_DB_IO, "About to write %04X to %04X\n",
Andy Grover's avatar
Andy Grover committed
78
		ACPI_BITMASK_ALL_FIXED_STATUS,
79
		(u16) acpi_gbl_FADT->xpm1a_evt_blk.address));
Linus Torvalds's avatar
Linus Torvalds committed
80

81 82 83 84 85
	if (flags & ACPI_MTX_LOCK) {
		status = acpi_ut_acquire_mutex (ACPI_MTX_HARDWARE);
		if (ACPI_FAILURE (status)) {
			return_ACPI_STATUS (status);
		}
Andy Grover's avatar
Andy Grover committed
86
	}
Linus Torvalds's avatar
Linus Torvalds committed
87

88 89 90 91 92
	status = acpi_hw_register_write (ACPI_MTX_DO_NOT_LOCK, ACPI_REGISTER_PM1_STATUS,
			  ACPI_BITMASK_ALL_FIXED_STATUS);
	if (ACPI_FAILURE (status)) {
		goto unlock_and_exit;
	}
Linus Torvalds's avatar
Linus Torvalds committed
93

Andy Grover's avatar
Andy Grover committed
94
	/* Clear the fixed events */
Linus Torvalds's avatar
Linus Torvalds committed
95

96
	if (acpi_gbl_FADT->xpm1b_evt_blk.address) {
97
		status = acpi_hw_low_level_write (16, ACPI_BITMASK_ALL_FIXED_STATUS,
Andy Grover's avatar
Andy Grover committed
98
				 &acpi_gbl_FADT->xpm1b_evt_blk);
99 100 101
		if (ACPI_FAILURE (status)) {
			goto unlock_and_exit;
		}
Linus Torvalds's avatar
Linus Torvalds committed
102 103
	}

Andy Grover's avatar
Andy Grover committed
104
	/* Clear the GPE Bits in all GPE registers in all GPE blocks */
Linus Torvalds's avatar
Linus Torvalds committed
105

106
	status = acpi_ev_walk_gpe_list (acpi_hw_clear_gpe_block);
Linus Torvalds's avatar
Linus Torvalds committed
107

108
unlock_and_exit:
109 110 111
	if (flags & ACPI_MTX_LOCK) {
		(void) acpi_ut_release_mutex (ACPI_MTX_HARDWARE);
	}
112
	return_ACPI_STATUS (status);
Linus Torvalds's avatar
Linus Torvalds committed
113 114 115 116 117
}


/*******************************************************************************
 *
118
 * FUNCTION:    acpi_get_sleep_type_data
Linus Torvalds's avatar
Linus Torvalds committed
119
 *
120 121 122
 * PARAMETERS:  sleep_state         - Numeric sleep state
 *              *sleep_type_a        - Where SLP_TYPa is returned
 *              *sleep_type_b        - Where SLP_TYPb is returned
Linus Torvalds's avatar
Linus Torvalds committed
123 124 125
 *
 * RETURN:      Status - ACPI status
 *
Andy Grover's avatar
Andy Grover committed
126 127
 * DESCRIPTION: Obtain the SLP_TYPa and SLP_TYPb values for the requested sleep
 *              state.
Linus Torvalds's avatar
Linus Torvalds committed
128 129 130
 *
 ******************************************************************************/

Linus Torvalds's avatar
Linus Torvalds committed
131
acpi_status
132
acpi_get_sleep_type_data (
133 134 135
	u8                              sleep_state,
	u8                              *sleep_type_a,
	u8                              *sleep_type_b)
Linus Torvalds's avatar
Linus Torvalds committed
136
{
137 138
	acpi_status                     status = AE_OK;
	union acpi_operand_object       *obj_desc;
Linus Torvalds's avatar
Linus Torvalds committed
139 140


141
	ACPI_FUNCTION_TRACE ("acpi_get_sleep_type_data");
Linus Torvalds's avatar
Linus Torvalds committed
142 143 144


	/*
Andy Grover's avatar
Andy Grover committed
145
	 * Validate parameters
Linus Torvalds's avatar
Linus Torvalds committed
146 147
	 */
	if ((sleep_state > ACPI_S_STATES_MAX) ||
Andy Grover's avatar
Andy Grover committed
148
		!sleep_type_a || !sleep_type_b) {
Linus Torvalds's avatar
Linus Torvalds committed
149
		return_ACPI_STATUS (AE_BAD_PARAMETER);
Linus Torvalds's avatar
Linus Torvalds committed
150 151 152
	}

	/*
Andy Grover's avatar
Andy Grover committed
153
	 * Evaluate the namespace object containing the values for this state
Linus Torvalds's avatar
Linus Torvalds committed
154
	 */
155
	status = acpi_ns_evaluate_by_name ((char *) acpi_gbl_sleep_state_names[sleep_state],
Linus Torvalds's avatar
Linus Torvalds committed
156
			  NULL, &obj_desc);
Linus Torvalds's avatar
Linus Torvalds committed
157
	if (ACPI_FAILURE (status)) {
158
		ACPI_DEBUG_PRINT ((ACPI_DB_EXEC, "%s while evaluating sleep_state [%s]\n",
159
			acpi_format_exception (status), acpi_gbl_sleep_state_names[sleep_state]));
160

Linus Torvalds's avatar
Linus Torvalds committed
161
		return_ACPI_STATUS (status);
Linus Torvalds's avatar
Linus Torvalds committed
162 163
	}

Andy Grover's avatar
Andy Grover committed
164 165
	/* Must have a return object */

Linus Torvalds's avatar
Linus Torvalds committed
166
	if (!obj_desc) {
Andy Grover's avatar
Andy Grover committed
167
		ACPI_REPORT_ERROR (("Missing Sleep State object\n"));
Andy Grover's avatar
Andy Grover committed
168
		status = AE_NOT_EXIST;
Linus Torvalds's avatar
Linus Torvalds committed
169 170
	}

Andy Grover's avatar
Andy Grover committed
171
	/* It must be of type Package */
Linus Torvalds's avatar
Linus Torvalds committed
172

Andy Grover's avatar
Andy Grover committed
173 174 175 176
	else if (ACPI_GET_OBJECT_TYPE (obj_desc) != ACPI_TYPE_PACKAGE) {
		ACPI_REPORT_ERROR (("Sleep State object not a Package\n"));
		status = AE_AML_OPERAND_TYPE;
	}
Linus Torvalds's avatar
Linus Torvalds committed
177

Andy Grover's avatar
Andy Grover committed
178
	/* The package must have at least two elements */
Linus Torvalds's avatar
Linus Torvalds committed
179

Andy Grover's avatar
Andy Grover committed
180
	else if (obj_desc->package.count < 2) {
Andy Grover's avatar
Andy Grover committed
181 182
		ACPI_REPORT_ERROR (("Sleep State package does not have at least two elements\n"));
		status = AE_AML_NO_OPERAND;
Linus Torvalds's avatar
Linus Torvalds committed
183 184
	}

Andy Grover's avatar
Andy Grover committed
185 186 187 188 189 190 191
	/* The first two elements must both be of type Integer */

	else if ((ACPI_GET_OBJECT_TYPE (obj_desc->package.elements[0]) != ACPI_TYPE_INTEGER) ||
			 (ACPI_GET_OBJECT_TYPE (obj_desc->package.elements[1]) != ACPI_TYPE_INTEGER)) {
		ACPI_REPORT_ERROR (("Sleep State package elements are not both Integers (%s, %s)\n",
			acpi_ut_get_object_type_name (obj_desc->package.elements[0]),
			acpi_ut_get_object_type_name (obj_desc->package.elements[1])));
Andy Grover's avatar
Andy Grover committed
192
		status = AE_AML_OPERAND_TYPE;
Linus Torvalds's avatar
Linus Torvalds committed
193 194 195
	}
	else {
		/*
Andy Grover's avatar
Andy Grover committed
196
		 * Valid _Sx_ package size, type, and value
Linus Torvalds's avatar
Linus Torvalds committed
197
		 */
Andy Grover's avatar
Andy Grover committed
198 199
		*sleep_type_a = (u8) (obj_desc->package.elements[0])->integer.value;
		*sleep_type_b = (u8) (obj_desc->package.elements[1])->integer.value;
Linus Torvalds's avatar
Linus Torvalds committed
200 201
	}

Linus Torvalds's avatar
Linus Torvalds committed
202
	if (ACPI_FAILURE (status)) {
203
		ACPI_DEBUG_PRINT ((ACPI_DB_ERROR, "While evaluating sleep_state [%s], bad Sleep object %p type %s\n",
204
			acpi_gbl_sleep_state_names[sleep_state], obj_desc, acpi_ut_get_object_type_name (obj_desc)));
Linus Torvalds's avatar
Linus Torvalds committed
205
	}
Linus Torvalds's avatar
Linus Torvalds committed
206

Linus Torvalds's avatar
Linus Torvalds committed
207
	acpi_ut_remove_reference (obj_desc);
Linus Torvalds's avatar
Linus Torvalds committed
208
	return_ACPI_STATUS (status);
Linus Torvalds's avatar
Linus Torvalds committed
209 210 211 212 213
}


/*******************************************************************************
 *
214
 * FUNCTION:    acpi_hw_get_register_bit_mask
Linus Torvalds's avatar
Linus Torvalds committed
215
 *
216
 * PARAMETERS:  register_id         - Index of ACPI Register to access
Linus Torvalds's avatar
Linus Torvalds committed
217
 *
Andy Grover's avatar
Andy Grover committed
218
 * RETURN:      The bit mask to be used when accessing the register
Linus Torvalds's avatar
Linus Torvalds committed
219
 *
220
 * DESCRIPTION: Map register_id into a register bit mask.
Linus Torvalds's avatar
Linus Torvalds committed
221 222 223
 *
 ******************************************************************************/

224
struct acpi_bit_register_info *
Andy Grover's avatar
Andy Grover committed
225
acpi_hw_get_bit_register_info (
226
	u32                             register_id)
Linus Torvalds's avatar
Linus Torvalds committed
227
{
228
	ACPI_FUNCTION_NAME ("hw_get_bit_register_info");
Linus Torvalds's avatar
Linus Torvalds committed
229 230


Andy Grover's avatar
Andy Grover committed
231
	if (register_id > ACPI_BITREG_MAX) {
232
		ACPI_DEBUG_PRINT ((ACPI_DB_ERROR, "Invalid bit_register ID: %X\n", register_id));
Andy Grover's avatar
Andy Grover committed
233 234
		return (NULL);
	}
Linus Torvalds's avatar
Linus Torvalds committed
235

Andy Grover's avatar
Andy Grover committed
236 237
	return (&acpi_gbl_bit_register_info[register_id]);
}
Linus Torvalds's avatar
Linus Torvalds committed
238

Linus Torvalds's avatar
Linus Torvalds committed
239

Andy Grover's avatar
Andy Grover committed
240 241
/*******************************************************************************
 *
242
 * FUNCTION:    acpi_get_register
Andy Grover's avatar
Andy Grover committed
243
 *
244 245 246
 * PARAMETERS:  register_id     - ID of ACPI bit_register to access
 *              return_value    - Value that was read from the register
 *              Flags           - Lock the hardware or not
Andy Grover's avatar
Andy Grover committed
247 248 249 250
 *
 * RETURN:      Value is read from specified Register.  Value returned is
 *              normalized to bit0 (is shifted all the way right)
 *
251
 * DESCRIPTION: ACPI bit_register read function.
Andy Grover's avatar
Andy Grover committed
252 253
 *
 ******************************************************************************/
Linus Torvalds's avatar
Linus Torvalds committed
254

255 256
acpi_status
acpi_get_register (
257 258 259
	u32                             register_id,
	u32                             *return_value,
	u32                             flags)
Andy Grover's avatar
Andy Grover committed
260
{
261 262 263
	u32                             register_value = 0;
	struct acpi_bit_register_info   *bit_reg_info;
	acpi_status                     status;
Linus Torvalds's avatar
Linus Torvalds committed
264 265


266
	ACPI_FUNCTION_TRACE ("acpi_get_register");
Linus Torvalds's avatar
Linus Torvalds committed
267 268


Andy Grover's avatar
Andy Grover committed
269
	/* Get the info structure corresponding to the requested ACPI Register */
Linus Torvalds's avatar
Linus Torvalds committed
270

Andy Grover's avatar
Andy Grover committed
271 272 273 274
	bit_reg_info = acpi_hw_get_bit_register_info (register_id);
	if (!bit_reg_info) {
		return_ACPI_STATUS (AE_BAD_PARAMETER);
	}
Linus Torvalds's avatar
Linus Torvalds committed
275

276 277 278 279 280 281 282 283 284
	if (flags & ACPI_MTX_LOCK) {
		status = acpi_ut_acquire_mutex (ACPI_MTX_HARDWARE);
		if (ACPI_FAILURE (status)) {
			return_ACPI_STATUS (status);
		}
	}

	status = acpi_hw_register_read (ACPI_MTX_DO_NOT_LOCK,
			  bit_reg_info->parent_register, &register_value);
Linus Torvalds's avatar
Linus Torvalds committed
285

Andy Grover's avatar
Andy Grover committed
286 287 288
	if (flags & ACPI_MTX_LOCK) {
		(void) acpi_ut_release_mutex (ACPI_MTX_HARDWARE);
	}
Linus Torvalds's avatar
Linus Torvalds committed
289

290 291
	if (ACPI_SUCCESS (status)) {
		/* Normalize the value that was read */
Linus Torvalds's avatar
Linus Torvalds committed
292

293 294
		register_value = ((register_value & bit_reg_info->access_bit_mask)
				   >> bit_reg_info->bit_position);
Linus Torvalds's avatar
Linus Torvalds committed
295

296 297
		*return_value = register_value;

298 299
		ACPI_DEBUG_PRINT ((ACPI_DB_IO, "Read value %8.8X register %X\n",
				register_value, bit_reg_info->parent_register));
300 301 302
	}

	return_ACPI_STATUS (status);
Andy Grover's avatar
Andy Grover committed
303
}
Linus Torvalds's avatar
Linus Torvalds committed
304 305


Andy Grover's avatar
Andy Grover committed
306 307
/*******************************************************************************
 *
308
 * FUNCTION:    acpi_set_register
Andy Grover's avatar
Andy Grover committed
309
 *
310
 * PARAMETERS:  register_id     - ID of ACPI bit_register to access
Andy Grover's avatar
Andy Grover committed
311 312 313 314
 *              Value           - (only used on write) value to write to the
 *                                Register, NOT pre-normalized to the bit pos.
 *              Flags           - Lock the hardware or not
 *
315
 * RETURN:      None
Andy Grover's avatar
Andy Grover committed
316 317 318 319
 *
 * DESCRIPTION: ACPI Bit Register write function.
 *
 ******************************************************************************/
Linus Torvalds's avatar
Linus Torvalds committed
320

321 322
acpi_status
acpi_set_register (
323 324 325
	u32                             register_id,
	u32                             value,
	u32                             flags)
Andy Grover's avatar
Andy Grover committed
326
{
327 328 329
	u32                             register_value = 0;
	struct acpi_bit_register_info   *bit_reg_info;
	acpi_status                     status;
Linus Torvalds's avatar
Linus Torvalds committed
330 331


332
	ACPI_FUNCTION_TRACE_U32 ("acpi_set_register", register_id);
Linus Torvalds's avatar
Linus Torvalds committed
333 334


Andy Grover's avatar
Andy Grover committed
335
	/* Get the info structure corresponding to the requested ACPI Register */
Linus Torvalds's avatar
Linus Torvalds committed
336

Andy Grover's avatar
Andy Grover committed
337 338
	bit_reg_info = acpi_hw_get_bit_register_info (register_id);
	if (!bit_reg_info) {
339
		ACPI_REPORT_ERROR (("Bad ACPI HW register_id: %X\n", register_id));
Andy Grover's avatar
Andy Grover committed
340 341
		return_ACPI_STATUS (AE_BAD_PARAMETER);
	}
Linus Torvalds's avatar
Linus Torvalds committed
342

343 344 345 346 347 348 349
	if (flags & ACPI_MTX_LOCK) {
		status = acpi_ut_acquire_mutex (ACPI_MTX_HARDWARE);
		if (ACPI_FAILURE (status)) {
			return_ACPI_STATUS (status);
		}
	}

Andy Grover's avatar
Andy Grover committed
350
	/* Always do a register read first so we can insert the new bits  */
Linus Torvalds's avatar
Linus Torvalds committed
351

352 353 354 355 356
	status = acpi_hw_register_read (ACPI_MTX_DO_NOT_LOCK,
			  bit_reg_info->parent_register, &register_value);
	if (ACPI_FAILURE (status)) {
		goto unlock_and_exit;
	}
Linus Torvalds's avatar
Linus Torvalds committed
357

Andy Grover's avatar
Andy Grover committed
358 359
	/*
	 * Decode the Register ID
360
	 * Register ID = [Register block ID] | [bit ID]
Andy Grover's avatar
Andy Grover committed
361
	 *
362
	 * Check bit ID to fine locate Register offset.
Andy Grover's avatar
Andy Grover committed
363 364 365 366
	 * Check Mask to determine Register offset, and then read-write.
	 */
	switch (bit_reg_info->parent_register) {
	case ACPI_REGISTER_PM1_STATUS:
Linus Torvalds's avatar
Linus Torvalds committed
367

Andy Grover's avatar
Andy Grover committed
368 369
		/*
		 * Status Registers are different from the rest.  Clear by
370
		 * writing 1, and writing 0 has no effect.  So, the only relevant
Andy Grover's avatar
Andy Grover committed
371
		 * information is the single bit we're interested in, all others should
372
		 * be written as 0 so they will be left unchanged.
Andy Grover's avatar
Andy Grover committed
373
		 */
374 375
		value = ACPI_REGISTER_PREPARE_BITS (value,
				 bit_reg_info->bit_position, bit_reg_info->access_bit_mask);
Andy Grover's avatar
Andy Grover committed
376
		if (value) {
377 378
			status = acpi_hw_register_write (ACPI_MTX_DO_NOT_LOCK,
					 ACPI_REGISTER_PM1_STATUS, (u16) value);
Andy Grover's avatar
Andy Grover committed
379 380 381
			register_value = 0;
		}
		break;
Linus Torvalds's avatar
Linus Torvalds committed
382 383


Andy Grover's avatar
Andy Grover committed
384
	case ACPI_REGISTER_PM1_ENABLE:
Linus Torvalds's avatar
Linus Torvalds committed
385

386 387
		ACPI_REGISTER_INSERT_VALUE (register_value, bit_reg_info->bit_position,
				bit_reg_info->access_bit_mask, value);
Linus Torvalds's avatar
Linus Torvalds committed
388

389 390
		status = acpi_hw_register_write (ACPI_MTX_DO_NOT_LOCK,
				  ACPI_REGISTER_PM1_ENABLE, (u16) register_value);
Andy Grover's avatar
Andy Grover committed
391
		break;
Linus Torvalds's avatar
Linus Torvalds committed
392 393


Andy Grover's avatar
Andy Grover committed
394
	case ACPI_REGISTER_PM1_CONTROL:
Linus Torvalds's avatar
Linus Torvalds committed
395 396

		/*
397
		 * Write the PM1 Control register.
Linus Torvalds's avatar
Linus Torvalds committed
398
		 * Note that at this level, the fact that there are actually TWO
399
		 * registers (A and B - and B may not exist) is abstracted.
Linus Torvalds's avatar
Linus Torvalds committed
400
		 */
Linus Torvalds's avatar
Linus Torvalds committed
401 402
		ACPI_DEBUG_PRINT ((ACPI_DB_IO, "PM1 control: Read %X\n", register_value));

403 404
		ACPI_REGISTER_INSERT_VALUE (register_value, bit_reg_info->bit_position,
				bit_reg_info->access_bit_mask, value);
Linus Torvalds's avatar
Linus Torvalds committed
405

406 407
		status = acpi_hw_register_write (ACPI_MTX_DO_NOT_LOCK,
				  ACPI_REGISTER_PM1_CONTROL, (u16) register_value);
Andy Grover's avatar
Andy Grover committed
408
		break;
Linus Torvalds's avatar
Linus Torvalds committed
409 410


Andy Grover's avatar
Andy Grover committed
411
	case ACPI_REGISTER_PM2_CONTROL:
Linus Torvalds's avatar
Linus Torvalds committed
412

413 414 415 416 417
		status = acpi_hw_register_read (ACPI_MTX_DO_NOT_LOCK,
				 ACPI_REGISTER_PM2_CONTROL, &register_value);
		if (ACPI_FAILURE (status)) {
			goto unlock_and_exit;
		}
Linus Torvalds's avatar
Linus Torvalds committed
418

Linus Torvalds's avatar
Linus Torvalds committed
419
		ACPI_DEBUG_PRINT ((ACPI_DB_IO, "PM2 control: Read %X from %8.8X%8.8X\n",
420
			register_value,
421
			ACPI_FORMAT_UINT64 (acpi_gbl_FADT->xpm2_cnt_blk.address)));
Linus Torvalds's avatar
Linus Torvalds committed
422

423 424
		ACPI_REGISTER_INSERT_VALUE (register_value, bit_reg_info->bit_position,
				bit_reg_info->access_bit_mask, value);
Linus Torvalds's avatar
Linus Torvalds committed
425

426
		ACPI_DEBUG_PRINT ((ACPI_DB_IO, "About to write %4.4X to %8.8X%8.8X\n",
Linus Torvalds's avatar
Linus Torvalds committed
427
			register_value,
428
			ACPI_FORMAT_UINT64 (acpi_gbl_FADT->xpm2_cnt_blk.address)));
Linus Torvalds's avatar
Linus Torvalds committed
429

430
		status = acpi_hw_register_write (ACPI_MTX_DO_NOT_LOCK,
Andy Grover's avatar
Andy Grover committed
431
				   ACPI_REGISTER_PM2_CONTROL, (u8) (register_value));
Linus Torvalds's avatar
Linus Torvalds committed
432 433 434 435 436 437 438
		break;


	default:
		break;
	}

439 440 441

unlock_and_exit:

Andy Grover's avatar
Andy Grover committed
442 443
	if (flags & ACPI_MTX_LOCK) {
		(void) acpi_ut_release_mutex (ACPI_MTX_HARDWARE);
Linus Torvalds's avatar
Linus Torvalds committed
444 445
	}

Andy Grover's avatar
Andy Grover committed
446
	/* Normalize the value that was read */
Linus Torvalds's avatar
Linus Torvalds committed
447

448
	ACPI_DEBUG_EXEC (register_value = ((register_value & bit_reg_info->access_bit_mask) >> bit_reg_info->bit_position));
Linus Torvalds's avatar
Linus Torvalds committed
449

450 451
	ACPI_DEBUG_PRINT ((ACPI_DB_IO, "Set bits: %8.8X actual %8.8X register %X\n",
			value, register_value, bit_reg_info->parent_register));
452
	return_ACPI_STATUS (status);
Linus Torvalds's avatar
Linus Torvalds committed
453 454 455 456 457
}


/******************************************************************************
 *
458
 * FUNCTION:    acpi_hw_register_read
Linus Torvalds's avatar
Linus Torvalds committed
459
 *
460 461
 * PARAMETERS:  use_lock               - Mutex hw access.
 *              register_id            - register_iD + Offset.
Linus Torvalds's avatar
Linus Torvalds committed
462 463 464 465 466 467 468 469
 *
 * RETURN:      Value read or written.
 *
 * DESCRIPTION: Acpi register read function.  Registers are read at the
 *              given offset.
 *
 ******************************************************************************/

470
acpi_status
Linus Torvalds's avatar
Linus Torvalds committed
471
acpi_hw_register_read (
472 473 474
	u8                              use_lock,
	u32                             register_id,
	u32                             *return_value)
Linus Torvalds's avatar
Linus Torvalds committed
475
{
476 477 478
	u32                             value1 = 0;
	u32                             value2 = 0;
	acpi_status                     status;
Linus Torvalds's avatar
Linus Torvalds committed
479

Linus Torvalds's avatar
Linus Torvalds committed
480

481
	ACPI_FUNCTION_TRACE ("hw_register_read");
Linus Torvalds's avatar
Linus Torvalds committed
482 483


Linus Torvalds's avatar
Linus Torvalds committed
484
	if (ACPI_MTX_LOCK == use_lock) {
485 486 487
		status = acpi_ut_acquire_mutex (ACPI_MTX_HARDWARE);
		if (ACPI_FAILURE (status)) {
			return_ACPI_STATUS (status);
Andy Grover's avatar
Andy Grover committed
488
		}
Linus Torvalds's avatar
Linus Torvalds committed
489 490
	}

Andy Grover's avatar
Andy Grover committed
491 492
	switch (register_id) {
	case ACPI_REGISTER_PM1_STATUS:           /* 16-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
493

Andy Grover's avatar
Andy Grover committed
494
		status = acpi_hw_low_level_read (16, &value1, &acpi_gbl_FADT->xpm1a_evt_blk);
495 496 497 498
		if (ACPI_FAILURE (status)) {
			goto unlock_and_exit;
		}

Andy Grover's avatar
Andy Grover committed
499 500 501
		/* PM1B is optional */

		status = acpi_hw_low_level_read (16, &value2, &acpi_gbl_FADT->xpm1b_evt_blk);
502
		value1 |= value2;
Linus Torvalds's avatar
Linus Torvalds committed
503 504 505
		break;


Andy Grover's avatar
Andy Grover committed
506
	case ACPI_REGISTER_PM1_ENABLE:           /* 16-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
507

Andy Grover's avatar
Andy Grover committed
508
		status = acpi_hw_low_level_read (16, &value1, &acpi_gbl_xpm1a_enable);
509 510 511 512
		if (ACPI_FAILURE (status)) {
			goto unlock_and_exit;
		}

Andy Grover's avatar
Andy Grover committed
513 514 515
		/* PM1B is optional */

		status = acpi_hw_low_level_read (16, &value2, &acpi_gbl_xpm1b_enable);
516
		value1 |= value2;
Linus Torvalds's avatar
Linus Torvalds committed
517 518 519
		break;


Andy Grover's avatar
Andy Grover committed
520
	case ACPI_REGISTER_PM1_CONTROL:          /* 16-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
521

Andy Grover's avatar
Andy Grover committed
522
		status = acpi_hw_low_level_read (16, &value1, &acpi_gbl_FADT->xpm1a_cnt_blk);
523 524 525 526
		if (ACPI_FAILURE (status)) {
			goto unlock_and_exit;
		}

Andy Grover's avatar
Andy Grover committed
527
		status = acpi_hw_low_level_read (16, &value2, &acpi_gbl_FADT->xpm1b_cnt_blk);
528
		value1 |= value2;
Linus Torvalds's avatar
Linus Torvalds committed
529 530 531
		break;


Andy Grover's avatar
Andy Grover committed
532
	case ACPI_REGISTER_PM2_CONTROL:          /* 8-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
533

Andy Grover's avatar
Andy Grover committed
534
		status = acpi_hw_low_level_read (8, &value1, &acpi_gbl_FADT->xpm2_cnt_blk);
Linus Torvalds's avatar
Linus Torvalds committed
535 536 537
		break;


Andy Grover's avatar
Andy Grover committed
538
	case ACPI_REGISTER_PM_TIMER:             /* 32-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
539

Andy Grover's avatar
Andy Grover committed
540
		status = acpi_hw_low_level_read (32, &value1, &acpi_gbl_FADT->xpm_tmr_blk);
Linus Torvalds's avatar
Linus Torvalds committed
541 542
		break;

Andy Grover's avatar
Andy Grover committed
543
	case ACPI_REGISTER_SMI_COMMAND_BLOCK:    /* 8-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
544

545
		status = acpi_os_read_port (acpi_gbl_FADT->smi_cmd, &value1, 8);
Linus Torvalds's avatar
Linus Torvalds committed
546 547 548
		break;

	default:
549 550
		ACPI_DEBUG_PRINT ((ACPI_DB_ERROR, "Unknown Register ID: %X\n", register_id));
		status = AE_BAD_PARAMETER;
Linus Torvalds's avatar
Linus Torvalds committed
551 552 553
		break;
	}

554
unlock_and_exit:
Linus Torvalds's avatar
Linus Torvalds committed
555
	if (ACPI_MTX_LOCK == use_lock) {
Andy Grover's avatar
Andy Grover committed
556
		(void) acpi_ut_release_mutex (ACPI_MTX_HARDWARE);
Linus Torvalds's avatar
Linus Torvalds committed
557 558
	}

559 560 561 562 563
	if (ACPI_SUCCESS (status)) {
		*return_value = value1;
	}

	return_ACPI_STATUS (status);
Linus Torvalds's avatar
Linus Torvalds committed
564 565 566 567 568
}


/******************************************************************************
 *
569
 * FUNCTION:    acpi_hw_register_write
Linus Torvalds's avatar
Linus Torvalds committed
570
 *
571 572
 * PARAMETERS:  use_lock               - Mutex hw access.
 *              register_id            - register_iD + Offset.
Linus Torvalds's avatar
Linus Torvalds committed
573 574 575 576 577 578 579 580
 *
 * RETURN:      Value read or written.
 *
 * DESCRIPTION: Acpi register Write function.  Registers are written at the
 *              given offset.
 *
 ******************************************************************************/

581
acpi_status
Linus Torvalds's avatar
Linus Torvalds committed
582
acpi_hw_register_write (
583 584 585
	u8                              use_lock,
	u32                             register_id,
	u32                             value)
Linus Torvalds's avatar
Linus Torvalds committed
586
{
587
	acpi_status                     status;
Linus Torvalds's avatar
Linus Torvalds committed
588 589


590
	ACPI_FUNCTION_TRACE ("hw_register_write");
Linus Torvalds's avatar
Linus Torvalds committed
591 592


Linus Torvalds's avatar
Linus Torvalds committed
593
	if (ACPI_MTX_LOCK == use_lock) {
594 595 596
		status = acpi_ut_acquire_mutex (ACPI_MTX_HARDWARE);
		if (ACPI_FAILURE (status)) {
			return_ACPI_STATUS (status);
Andy Grover's avatar
Andy Grover committed
597
		}
Linus Torvalds's avatar
Linus Torvalds committed
598 599
	}

Andy Grover's avatar
Andy Grover committed
600 601
	switch (register_id) {
	case ACPI_REGISTER_PM1_STATUS:           /* 16-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
602

Andy Grover's avatar
Andy Grover committed
603
		status = acpi_hw_low_level_write (16, value, &acpi_gbl_FADT->xpm1a_evt_blk);
604 605 606 607
		if (ACPI_FAILURE (status)) {
			goto unlock_and_exit;
		}

Andy Grover's avatar
Andy Grover committed
608 609 610
		/* PM1B is optional */

		status = acpi_hw_low_level_write (16, value, &acpi_gbl_FADT->xpm1b_evt_blk);
Linus Torvalds's avatar
Linus Torvalds committed
611 612 613
		break;


Andy Grover's avatar
Andy Grover committed
614
	case ACPI_REGISTER_PM1_ENABLE:           /* 16-bit access*/
Linus Torvalds's avatar
Linus Torvalds committed
615

Andy Grover's avatar
Andy Grover committed
616
		status = acpi_hw_low_level_write (16, value, &acpi_gbl_xpm1a_enable);
617 618 619 620
		if (ACPI_FAILURE (status)) {
			goto unlock_and_exit;
		}

Andy Grover's avatar
Andy Grover committed
621 622 623
		/* PM1B is optional */

		status = acpi_hw_low_level_write (16, value, &acpi_gbl_xpm1b_enable);
Linus Torvalds's avatar
Linus Torvalds committed
624 625 626
		break;


Andy Grover's avatar
Andy Grover committed
627
	case ACPI_REGISTER_PM1_CONTROL:          /* 16-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
628

Andy Grover's avatar
Andy Grover committed
629
		status = acpi_hw_low_level_write (16, value, &acpi_gbl_FADT->xpm1a_cnt_blk);
630 631 632 633
		if (ACPI_FAILURE (status)) {
			goto unlock_and_exit;
		}

Andy Grover's avatar
Andy Grover committed
634
		status = acpi_hw_low_level_write (16, value, &acpi_gbl_FADT->xpm1b_cnt_blk);
Linus Torvalds's avatar
Linus Torvalds committed
635
		break;
Linus Torvalds's avatar
Linus Torvalds committed
636 637


Andy Grover's avatar
Andy Grover committed
638
	case ACPI_REGISTER_PM1A_CONTROL:         /* 16-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
639

Andy Grover's avatar
Andy Grover committed
640
		status = acpi_hw_low_level_write (16, value, &acpi_gbl_FADT->xpm1a_cnt_blk);
Linus Torvalds's avatar
Linus Torvalds committed
641 642 643
		break;


Andy Grover's avatar
Andy Grover committed
644
	case ACPI_REGISTER_PM1B_CONTROL:         /* 16-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
645

Andy Grover's avatar
Andy Grover committed
646
		status = acpi_hw_low_level_write (16, value, &acpi_gbl_FADT->xpm1b_cnt_blk);
Linus Torvalds's avatar
Linus Torvalds committed
647 648 649
		break;


Andy Grover's avatar
Andy Grover committed
650
	case ACPI_REGISTER_PM2_CONTROL:          /* 8-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
651

Andy Grover's avatar
Andy Grover committed
652
		status = acpi_hw_low_level_write (8, value, &acpi_gbl_FADT->xpm2_cnt_blk);
Linus Torvalds's avatar
Linus Torvalds committed
653 654 655
		break;


Andy Grover's avatar
Andy Grover committed
656
	case ACPI_REGISTER_PM_TIMER:             /* 32-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
657

Andy Grover's avatar
Andy Grover committed
658
		status = acpi_hw_low_level_write (32, value, &acpi_gbl_FADT->xpm_tmr_blk);
Linus Torvalds's avatar
Linus Torvalds committed
659 660 661
		break;


Andy Grover's avatar
Andy Grover committed
662
	case ACPI_REGISTER_SMI_COMMAND_BLOCK:    /* 8-bit access */
Linus Torvalds's avatar
Linus Torvalds committed
663

Andy Grover's avatar
Andy Grover committed
664
		/* SMI_CMD is currently always in IO space */
Linus Torvalds's avatar
Linus Torvalds committed
665

666
		status = acpi_os_write_port (acpi_gbl_FADT->smi_cmd, value, 8);
Linus Torvalds's avatar
Linus Torvalds committed
667 668 669 670
		break;


	default:
671
		status = AE_BAD_PARAMETER;
Linus Torvalds's avatar
Linus Torvalds committed
672 673 674
		break;
	}

675
unlock_and_exit:
Linus Torvalds's avatar
Linus Torvalds committed
676
	if (ACPI_MTX_LOCK == use_lock) {
Andy Grover's avatar
Andy Grover committed
677
		(void) acpi_ut_release_mutex (ACPI_MTX_HARDWARE);
Linus Torvalds's avatar
Linus Torvalds committed
678 679
	}

680
	return_ACPI_STATUS (status);
Linus Torvalds's avatar
Linus Torvalds committed
681 682 683 684 685
}


/******************************************************************************
 *
686
 * FUNCTION:    acpi_hw_low_level_read
Linus Torvalds's avatar
Linus Torvalds committed
687
 *
Andy Grover's avatar
Andy Grover committed
688 689 690
 * PARAMETERS:  Width               - 8, 16, or 32
 *              Value               - Where the value is returned
 *              Register            - GAS register structure
Linus Torvalds's avatar
Linus Torvalds committed
691
 *
Andy Grover's avatar
Andy Grover committed
692
 * RETURN:      Status
Linus Torvalds's avatar
Linus Torvalds committed
693 694 695 696 697
 *
 * DESCRIPTION: Read from either memory, IO, or PCI config space.
 *
 ******************************************************************************/

698
acpi_status
Linus Torvalds's avatar
Linus Torvalds committed
699
acpi_hw_low_level_read (
700 701
	u32                             width,
	u32                             *value,
Andy Grover's avatar
Andy Grover committed
702
	struct acpi_generic_address     *reg)
Linus Torvalds's avatar
Linus Torvalds committed
703
{
704 705 706
	struct acpi_pci_id              pci_id;
	u16                             pci_register;
	acpi_status                     status;
Linus Torvalds's avatar
Linus Torvalds committed
707 708


709
	ACPI_FUNCTION_NAME ("hw_low_level_read");
Linus Torvalds's avatar
Linus Torvalds committed
710 711 712 713


	/*
	 * Must have a valid pointer to a GAS structure, and
714 715
	 * a non-zero address within. However, don't return an error
	 * because the PM1A/B code must not fail if B isn't present.
Linus Torvalds's avatar
Linus Torvalds committed
716 717
	 */
	if ((!reg) ||
Andy Grover's avatar
Andy Grover committed
718
		(!reg->address)) {
719
		return (AE_OK);
Linus Torvalds's avatar
Linus Torvalds committed
720
	}
721
	*value = 0;
Linus Torvalds's avatar
Linus Torvalds committed
722 723 724

	/*
	 * Three address spaces supported:
725
	 * Memory, IO, or PCI_Config.
Linus Torvalds's avatar
Linus Torvalds committed
726
	 */
Linus Torvalds's avatar
Linus Torvalds committed
727 728
	switch (reg->address_space_id) {
	case ACPI_ADR_SPACE_SYSTEM_MEMORY:
Linus Torvalds's avatar
Linus Torvalds committed
729

Andy Grover's avatar
Andy Grover committed
730 731 732
		status = acpi_os_read_memory (
				 (acpi_physical_address) reg->address,
				 value, width);
Linus Torvalds's avatar
Linus Torvalds committed
733 734 735
		break;


Linus Torvalds's avatar
Linus Torvalds committed
736
	case ACPI_ADR_SPACE_SYSTEM_IO:
Linus Torvalds's avatar
Linus Torvalds committed
737

Andy Grover's avatar
Andy Grover committed
738 739
		status = acpi_os_read_port ((acpi_io_address) reg->address,
				 value, width);
Linus Torvalds's avatar
Linus Torvalds committed
740 741 742
		break;


Linus Torvalds's avatar
Linus Torvalds committed
743
	case ACPI_ADR_SPACE_PCI_CONFIG:
Linus Torvalds's avatar
Linus Torvalds committed
744

Linus Torvalds's avatar
Linus Torvalds committed
745 746
		pci_id.segment = 0;
		pci_id.bus     = 0;
Andy Grover's avatar
Andy Grover committed
747 748
		pci_id.device  = ACPI_PCI_DEVICE (reg->address);
		pci_id.function = ACPI_PCI_FUNCTION (reg->address);
Andy Grover's avatar
Andy Grover committed
749
		pci_register   = (u16) ACPI_PCI_REGISTER (reg->address);
750

Andy Grover's avatar
Andy Grover committed
751 752
		status = acpi_os_read_pci_configuration (&pci_id, pci_register,
				 value, width);
753 754
		break;

Linus Torvalds's avatar
Linus Torvalds committed
755

756
	default:
Andy Grover's avatar
Andy Grover committed
757 758
		ACPI_DEBUG_PRINT ((ACPI_DB_ERROR,
			"Unsupported address space: %X\n", reg->address_space_id));
759
		return (AE_BAD_PARAMETER);
Linus Torvalds's avatar
Linus Torvalds committed
760 761
	}

762 763
	ACPI_DEBUG_PRINT ((ACPI_DB_IO, "Read:  %8.8X width %2d from %8.8X%8.8X (%s)\n",
			*value, width,
764
			ACPI_FORMAT_UINT64 (reg->address),
765 766
			acpi_ut_get_region_name (reg->address_space_id)));

767
	return (status);
Linus Torvalds's avatar
Linus Torvalds committed
768 769 770 771 772
}


/******************************************************************************
 *
773
 * FUNCTION:    acpi_hw_low_level_write
Linus Torvalds's avatar
Linus Torvalds committed
774 775 776 777 778
 *
 * PARAMETERS:  Width               - 8, 16, or 32
 *              Value               - To be written
 *              Register            - GAS register structure
 *
Andy Grover's avatar
Andy Grover committed
779
 * RETURN:      Status
Linus Torvalds's avatar
Linus Torvalds committed
780
 *
Andy Grover's avatar
Andy Grover committed
781
 * DESCRIPTION: Write to either memory, IO, or PCI config space.
Linus Torvalds's avatar
Linus Torvalds committed
782 783 784
 *
 ******************************************************************************/

785
acpi_status
Linus Torvalds's avatar
Linus Torvalds committed
786
acpi_hw_low_level_write (
787 788
	u32                             width,
	u32                             value,
Andy Grover's avatar
Andy Grover committed
789
	struct acpi_generic_address     *reg)
Linus Torvalds's avatar
Linus Torvalds committed
790
{
791 792 793
	struct acpi_pci_id              pci_id;
	u16                             pci_register;
	acpi_status                     status;
Linus Torvalds's avatar
Linus Torvalds committed
794 795


796
	ACPI_FUNCTION_NAME ("hw_low_level_write");
Linus Torvalds's avatar
Linus Torvalds committed
797 798 799 800


	/*
	 * Must have a valid pointer to a GAS structure, and
801 802
	 * a non-zero address within. However, don't return an error
	 * because the PM1A/B code must not fail if B isn't present.
Linus Torvalds's avatar
Linus Torvalds committed
803 804
	 */
	if ((!reg) ||
Andy Grover's avatar
Andy Grover committed
805
		(!reg->address)) {
806
		return (AE_OK);
Linus Torvalds's avatar
Linus Torvalds committed
807
	}
808

Linus Torvalds's avatar
Linus Torvalds committed
809 810
	/*
	 * Three address spaces supported:
811
	 * Memory, IO, or PCI_Config.
Linus Torvalds's avatar
Linus Torvalds committed
812
	 */
Linus Torvalds's avatar
Linus Torvalds committed
813 814
	switch (reg->address_space_id) {
	case ACPI_ADR_SPACE_SYSTEM_MEMORY:
Linus Torvalds's avatar
Linus Torvalds committed
815

Andy Grover's avatar
Andy Grover committed
816 817 818
		status = acpi_os_write_memory (
				 (acpi_physical_address) reg->address,
				 value, width);
Linus Torvalds's avatar
Linus Torvalds committed
819 820 821
		break;


Linus Torvalds's avatar
Linus Torvalds committed
822
	case ACPI_ADR_SPACE_SYSTEM_IO:
Linus Torvalds's avatar
Linus Torvalds committed
823

Andy Grover's avatar
Andy Grover committed
824 825
		status = acpi_os_write_port ((acpi_io_address) reg->address,
				 value, width);
Linus Torvalds's avatar
Linus Torvalds committed
826 827 828
		break;


Linus Torvalds's avatar
Linus Torvalds committed
829
	case ACPI_ADR_SPACE_PCI_CONFIG:
Linus Torvalds's avatar
Linus Torvalds committed
830

Linus Torvalds's avatar
Linus Torvalds committed
831 832
		pci_id.segment = 0;
		pci_id.bus     = 0;
Andy Grover's avatar
Andy Grover committed
833 834
		pci_id.device  = ACPI_PCI_DEVICE (reg->address);
		pci_id.function = ACPI_PCI_FUNCTION (reg->address);
Andy Grover's avatar
Andy Grover committed
835
		pci_register   = (u16) ACPI_PCI_REGISTER (reg->address);
Linus Torvalds's avatar
Linus Torvalds committed
836

Andy Grover's avatar
Andy Grover committed
837 838
		status = acpi_os_write_pci_configuration (&pci_id, pci_register,
				 (acpi_integer) value, width);
839 840 841 842
		break;


	default:
Andy Grover's avatar
Andy Grover committed
843 844
		ACPI_DEBUG_PRINT ((ACPI_DB_ERROR,
			"Unsupported address space: %X\n", reg->address_space_id));
845
		return (AE_BAD_PARAMETER);
Linus Torvalds's avatar
Linus Torvalds committed
846
	}
847

848 849
	ACPI_DEBUG_PRINT ((ACPI_DB_IO, "Wrote: %8.8X width %2d   to %8.8X%8.8X (%s)\n",
			value, width,
850
			ACPI_FORMAT_UINT64 (reg->address),
851 852
			acpi_ut_get_region_name (reg->address_space_id)));

853
	return (status);
Linus Torvalds's avatar
Linus Torvalds committed
854
}