blob: 41f1173e02c27983d1bba4c0ff2b4fed24bf8df5 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001
2/*******************************************************************************
3 *
4 * Module Name: hwregs - Read/write access functions for the various ACPI
5 * control and status registers.
6 *
7 ******************************************************************************/
8
9/*
Len Brown75a44ce2008-04-23 23:00:13 -040010 * Copyright (C) 2000 - 2008, Intel Corp.
Linus Torvalds1da177e2005-04-16 15:20:36 -070011 * All rights reserved.
12 *
13 * Redistribution and use in source and binary forms, with or without
14 * modification, are permitted provided that the following conditions
15 * are met:
16 * 1. Redistributions of source code must retain the above copyright
17 * notice, this list of conditions, and the following disclaimer,
18 * without modification.
19 * 2. Redistributions in binary form must reproduce at minimum a disclaimer
20 * substantially similar to the "NO WARRANTY" disclaimer below
21 * ("Disclaimer") and any redistribution must be conditioned upon
22 * including a substantially similar Disclaimer requirement for further
23 * binary redistribution.
24 * 3. Neither the names of the above-listed copyright holders nor the names
25 * of any contributors may be used to endorse or promote products derived
26 * from this software without specific prior written permission.
27 *
28 * Alternatively, this software may be distributed under the terms of the
29 * GNU General Public License ("GPL") version 2 as published by the Free
30 * Software Foundation.
31 *
32 * NO WARRANTY
33 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
34 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
35 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
36 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
37 * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
38 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
39 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
40 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
41 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
42 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
43 * POSSIBILITY OF SUCH DAMAGES.
44 */
45
Linus Torvalds1da177e2005-04-16 15:20:36 -070046#include <acpi/acpi.h>
Len Browne2f7a772009-01-09 00:30:03 -050047#include "accommon.h"
48#include "acnamesp.h"
49#include "acevents.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070050
51#define _COMPONENT ACPI_HARDWARE
Len Brown4be44fc2005-08-05 00:44:28 -040052ACPI_MODULE_NAME("hwregs")
Linus Torvalds1da177e2005-04-16 15:20:36 -070053
Bob Moorec520aba2009-02-18 14:20:12 +080054/* Local Prototypes */
55static acpi_status
56acpi_hw_read_multiple(u32 *value,
57 struct acpi_generic_address *register_a,
58 struct acpi_generic_address *register_b);
59
60static acpi_status
61acpi_hw_write_multiple(u32 value,
62 struct acpi_generic_address *register_a,
63 struct acpi_generic_address *register_b);
64
Linus Torvalds1da177e2005-04-16 15:20:36 -070065/*******************************************************************************
66 *
67 * FUNCTION: acpi_hw_clear_acpi_status
68 *
Bob Moored8c71b62007-02-02 19:48:21 +030069 * PARAMETERS: None
Linus Torvalds1da177e2005-04-16 15:20:36 -070070 *
Bob Moore7db5d822008-12-30 11:04:48 +080071 * RETURN: Status
Linus Torvalds1da177e2005-04-16 15:20:36 -070072 *
73 * DESCRIPTION: Clears all fixed and general purpose status bits
74 * THIS FUNCTION MUST BE CALLED WITH INTERRUPTS DISABLED
75 *
76 ******************************************************************************/
Bob Moorec520aba2009-02-18 14:20:12 +080077
Bob Moored8c71b62007-02-02 19:48:21 +030078acpi_status acpi_hw_clear_acpi_status(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -070079{
Len Brown4be44fc2005-08-05 00:44:28 -040080 acpi_status status;
Bob Moore4c90ece2006-06-08 16:29:00 -040081 acpi_cpu_flags lock_flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070082
Bob Mooreb229cf92006-04-21 17:15:00 -040083 ACPI_FUNCTION_TRACE(hw_clear_acpi_status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070084
Len Brown4be44fc2005-08-05 00:44:28 -040085 ACPI_DEBUG_PRINT((ACPI_DB_IO, "About to write %04X to %04X\n",
86 ACPI_BITMASK_ALL_FIXED_STATUS,
Bob Moore531c6332009-02-18 14:06:12 +080087 (u16) acpi_gbl_xpm1a_status.address));
Linus Torvalds1da177e2005-04-16 15:20:36 -070088
Bob Moore4c90ece2006-06-08 16:29:00 -040089 lock_flags = acpi_os_acquire_lock(acpi_gbl_hardware_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -070090
Bob Moore531c6332009-02-18 14:06:12 +080091 /* Clear the fixed events */
92
Alexey Starikovskiyd30dc9ab2007-09-30 22:39:36 +040093 status = acpi_hw_register_write(ACPI_REGISTER_PM1_STATUS,
Len Brown4be44fc2005-08-05 00:44:28 -040094 ACPI_BITMASK_ALL_FIXED_STATUS);
95 if (ACPI_FAILURE(status)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -070096 goto unlock_and_exit;
97 }
98
Bob Moore531c6332009-02-18 14:06:12 +080099 /* Write PM1B register if present */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100
Bob Moore531c6332009-02-18 14:06:12 +0800101 if (acpi_gbl_xpm1b_status.address) {
Bob Mooreecfbbc72008-12-31 02:55:32 +0800102 status = acpi_write(ACPI_BITMASK_ALL_FIXED_STATUS,
Bob Moore531c6332009-02-18 14:06:12 +0800103 &acpi_gbl_xpm1b_status);
Len Brown4be44fc2005-08-05 00:44:28 -0400104 if (ACPI_FAILURE(status)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105 goto unlock_and_exit;
106 }
107 }
108
109 /* Clear the GPE Bits in all GPE registers in all GPE blocks */
110
Bob Mooree97d6bf2008-12-30 09:45:17 +0800111 status = acpi_ev_walk_gpe_list(acpi_hw_clear_gpe_block, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112
Len Brown4be44fc2005-08-05 00:44:28 -0400113 unlock_and_exit:
Bob Moore4c90ece2006-06-08 16:29:00 -0400114 acpi_os_release_lock(acpi_gbl_hardware_lock, lock_flags);
Len Brown4be44fc2005-08-05 00:44:28 -0400115 return_ACPI_STATUS(status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700116}
117
Linus Torvalds1da177e2005-04-16 15:20:36 -0700118/*******************************************************************************
119 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120 * FUNCTION: acpi_hw_get_register_bit_mask
121 *
122 * PARAMETERS: register_id - Index of ACPI Register to access
123 *
Robert Moore44f6c012005-04-18 22:49:35 -0400124 * RETURN: The bitmask to be used when accessing the register
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125 *
Robert Moore44f6c012005-04-18 22:49:35 -0400126 * DESCRIPTION: Map register_id into a register bitmask.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700127 *
128 ******************************************************************************/
Bob Moore7db5d822008-12-30 11:04:48 +0800129
Len Brown4be44fc2005-08-05 00:44:28 -0400130struct acpi_bit_register_info *acpi_hw_get_bit_register_info(u32 register_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700131{
Bob Moore4a90c7e2006-01-13 16:22:00 -0500132 ACPI_FUNCTION_ENTRY();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700133
134 if (register_id > ACPI_BITREG_MAX) {
Bob Mooreb229cf92006-04-21 17:15:00 -0400135 ACPI_ERROR((AE_INFO, "Invalid BitRegister ID: %X",
Bob Mooreb8e4d892006-01-27 16:43:00 -0500136 register_id));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700137 return (NULL);
138 }
139
140 return (&acpi_gbl_bit_register_info[register_id]);
141}
142
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143/******************************************************************************
144 *
145 * FUNCTION: acpi_hw_register_read
146 *
Alexey Starikovskiyd30dc9ab2007-09-30 22:39:36 +0400147 * PARAMETERS: register_id - ACPI Register ID
Robert Moore44f6c012005-04-18 22:49:35 -0400148 * return_value - Where the register value is returned
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149 *
150 * RETURN: Status and the value read.
151 *
Bob Moore967440e32006-06-23 17:04:00 -0400152 * DESCRIPTION: Read from the specified ACPI register
Linus Torvalds1da177e2005-04-16 15:20:36 -0700153 *
154 ******************************************************************************/
Linus Torvalds1da177e2005-04-16 15:20:36 -0700155acpi_status
Alexey Starikovskiyd30dc9ab2007-09-30 22:39:36 +0400156acpi_hw_register_read(u32 register_id, u32 * return_value)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700157{
Bob Moorec520aba2009-02-18 14:20:12 +0800158 u32 value = 0;
Len Brown4be44fc2005-08-05 00:44:28 -0400159 acpi_status status;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160
Bob Mooreb229cf92006-04-21 17:15:00 -0400161 ACPI_FUNCTION_TRACE(hw_register_read);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162
Linus Torvalds1da177e2005-04-16 15:20:36 -0700163 switch (register_id) {
Bob Moorec520aba2009-02-18 14:20:12 +0800164 case ACPI_REGISTER_PM1_STATUS: /* PM1 A/B: 16-bit access each */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165
Bob Moorec520aba2009-02-18 14:20:12 +0800166 status = acpi_hw_read_multiple(&value,
167 &acpi_gbl_xpm1a_status,
168 &acpi_gbl_xpm1b_status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700169 break;
170
Bob Moorec520aba2009-02-18 14:20:12 +0800171 case ACPI_REGISTER_PM1_ENABLE: /* PM1 A/B: 16-bit access each */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700172
Bob Moorec520aba2009-02-18 14:20:12 +0800173 status = acpi_hw_read_multiple(&value,
174 &acpi_gbl_xpm1a_enable,
175 &acpi_gbl_xpm1b_enable);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176 break;
177
Bob Moorec520aba2009-02-18 14:20:12 +0800178 case ACPI_REGISTER_PM1_CONTROL: /* PM1 A/B: 16-bit access each */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700179
Bob Moorec520aba2009-02-18 14:20:12 +0800180 status = acpi_hw_read_multiple(&value,
181 &acpi_gbl_FADT.
182 xpm1a_control_block,
183 &acpi_gbl_FADT.
184 xpm1b_control_block);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185 break;
186
Len Brown4be44fc2005-08-05 00:44:28 -0400187 case ACPI_REGISTER_PM2_CONTROL: /* 8-bit access */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700188
Bob Moorec520aba2009-02-18 14:20:12 +0800189 status = acpi_read(&value, &acpi_gbl_FADT.xpm2_control_block);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700190 break;
191
Len Brown4be44fc2005-08-05 00:44:28 -0400192 case ACPI_REGISTER_PM_TIMER: /* 32-bit access */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700193
Bob Moorec520aba2009-02-18 14:20:12 +0800194 status = acpi_read(&value, &acpi_gbl_FADT.xpm_timer_block);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700195 break;
196
Len Brown4be44fc2005-08-05 00:44:28 -0400197 case ACPI_REGISTER_SMI_COMMAND_BLOCK: /* 8-bit access */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198
Bob Mooref3d2e782007-02-02 19:48:18 +0300199 status =
Bob Moorec520aba2009-02-18 14:20:12 +0800200 acpi_os_read_port(acpi_gbl_FADT.smi_command, &value, 8);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201 break;
202
203 default:
Bob Mooreb8e4d892006-01-27 16:43:00 -0500204 ACPI_ERROR((AE_INFO, "Unknown Register ID: %X", register_id));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700205 status = AE_BAD_PARAMETER;
206 break;
207 }
208
Len Brown4be44fc2005-08-05 00:44:28 -0400209 if (ACPI_SUCCESS(status)) {
Bob Moorec520aba2009-02-18 14:20:12 +0800210 *return_value = value;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211 }
212
Len Brown4be44fc2005-08-05 00:44:28 -0400213 return_ACPI_STATUS(status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214}
215
Linus Torvalds1da177e2005-04-16 15:20:36 -0700216/******************************************************************************
217 *
218 * FUNCTION: acpi_hw_register_write
219 *
Alexey Starikovskiyd30dc9ab2007-09-30 22:39:36 +0400220 * PARAMETERS: register_id - ACPI Register ID
Linus Torvalds1da177e2005-04-16 15:20:36 -0700221 * Value - The value to write
222 *
223 * RETURN: Status
224 *
Bob Moore967440e32006-06-23 17:04:00 -0400225 * DESCRIPTION: Write to the specified ACPI register
226 *
227 * NOTE: In accordance with the ACPI specification, this function automatically
228 * preserves the value of the following bits, meaning that these bits cannot be
229 * changed via this interface:
230 *
231 * PM1_CONTROL[0] = SCI_EN
232 * PM1_CONTROL[9]
233 * PM1_STATUS[11]
234 *
235 * ACPI References:
236 * 1) Hardware Ignored Bits: When software writes to a register with ignored
237 * bit fields, it preserves the ignored bit fields
238 * 2) SCI_EN: OSPM always preserves this bit position
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239 *
240 ******************************************************************************/
241
Alexey Starikovskiyd30dc9ab2007-09-30 22:39:36 +0400242acpi_status acpi_hw_register_write(u32 register_id, u32 value)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700243{
Len Brown4be44fc2005-08-05 00:44:28 -0400244 acpi_status status;
Bob Moore967440e32006-06-23 17:04:00 -0400245 u32 read_value;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700246
Bob Mooreb229cf92006-04-21 17:15:00 -0400247 ACPI_FUNCTION_TRACE(hw_register_write);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248
Linus Torvalds1da177e2005-04-16 15:20:36 -0700249 switch (register_id) {
Bob Moorec520aba2009-02-18 14:20:12 +0800250 case ACPI_REGISTER_PM1_STATUS: /* PM1 A/B: 16-bit access each */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700251
Bob Moore967440e32006-06-23 17:04:00 -0400252 /* Perform a read first to preserve certain bits (per ACPI spec) */
253
Bob Moorec520aba2009-02-18 14:20:12 +0800254 status = acpi_hw_read_multiple(&read_value,
255 &acpi_gbl_xpm1a_status,
256 &acpi_gbl_xpm1b_status);
Bob Moore967440e32006-06-23 17:04:00 -0400257 if (ACPI_FAILURE(status)) {
Alexey Starikovskiyd30dc9ab2007-09-30 22:39:36 +0400258 goto exit;
Bob Moore967440e32006-06-23 17:04:00 -0400259 }
260
261 /* Insert the bits to be preserved */
262
263 ACPI_INSERT_BITS(value, ACPI_PM1_STATUS_PRESERVED_BITS,
264 read_value);
265
266 /* Now we can write the data */
267
Bob Moorec520aba2009-02-18 14:20:12 +0800268 status = acpi_hw_write_multiple(value,
269 &acpi_gbl_xpm1a_status,
270 &acpi_gbl_xpm1b_status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271 break;
272
Bob Moorec520aba2009-02-18 14:20:12 +0800273 case ACPI_REGISTER_PM1_ENABLE: /* PM1 A/B: 16-bit access */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274
Bob Moorec520aba2009-02-18 14:20:12 +0800275 status = acpi_hw_write_multiple(value,
276 &acpi_gbl_xpm1a_enable,
277 &acpi_gbl_xpm1b_enable);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700278 break;
279
Bob Moorec520aba2009-02-18 14:20:12 +0800280 case ACPI_REGISTER_PM1_CONTROL: /* PM1 A/B: 16-bit access each */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700281
Bob Moore967440e32006-06-23 17:04:00 -0400282 /*
283 * Perform a read first to preserve certain bits (per ACPI spec)
Bob Moorec520aba2009-02-18 14:20:12 +0800284 * Note: This includes SCI_EN, we never want to change this bit
Bob Moore967440e32006-06-23 17:04:00 -0400285 */
Bob Moorec520aba2009-02-18 14:20:12 +0800286 status = acpi_hw_read_multiple(&read_value,
287 &acpi_gbl_FADT.
288 xpm1a_control_block,
289 &acpi_gbl_FADT.
290 xpm1b_control_block);
Bob Moore967440e32006-06-23 17:04:00 -0400291 if (ACPI_FAILURE(status)) {
Alexey Starikovskiyd30dc9ab2007-09-30 22:39:36 +0400292 goto exit;
Bob Moore967440e32006-06-23 17:04:00 -0400293 }
294
295 /* Insert the bits to be preserved */
296
297 ACPI_INSERT_BITS(value, ACPI_PM1_CONTROL_PRESERVED_BITS,
298 read_value);
299
300 /* Now we can write the data */
301
Bob Moorec520aba2009-02-18 14:20:12 +0800302 status = acpi_hw_write_multiple(value,
303 &acpi_gbl_FADT.
304 xpm1a_control_block,
305 &acpi_gbl_FADT.
306 xpm1b_control_block);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700307 break;
308
Len Brown4be44fc2005-08-05 00:44:28 -0400309 case ACPI_REGISTER_PM1A_CONTROL: /* 16-bit access */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310
Bob Mooreecfbbc72008-12-31 02:55:32 +0800311 status = acpi_write(value, &acpi_gbl_FADT.xpm1a_control_block);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700312 break;
313
Len Brown4be44fc2005-08-05 00:44:28 -0400314 case ACPI_REGISTER_PM1B_CONTROL: /* 16-bit access */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700315
Bob Mooreecfbbc72008-12-31 02:55:32 +0800316 status = acpi_write(value, &acpi_gbl_FADT.xpm1b_control_block);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700317 break;
318
Len Brown4be44fc2005-08-05 00:44:28 -0400319 case ACPI_REGISTER_PM2_CONTROL: /* 8-bit access */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320
Bob Mooreecfbbc72008-12-31 02:55:32 +0800321 status = acpi_write(value, &acpi_gbl_FADT.xpm2_control_block);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322 break;
323
Len Brown4be44fc2005-08-05 00:44:28 -0400324 case ACPI_REGISTER_PM_TIMER: /* 32-bit access */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700325
Bob Mooreecfbbc72008-12-31 02:55:32 +0800326 status = acpi_write(value, &acpi_gbl_FADT.xpm_timer_block);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700327 break;
328
Len Brown4be44fc2005-08-05 00:44:28 -0400329 case ACPI_REGISTER_SMI_COMMAND_BLOCK: /* 8-bit access */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700330
331 /* SMI_CMD is currently always in IO space */
332
Bob Mooref3d2e782007-02-02 19:48:18 +0300333 status =
334 acpi_os_write_port(acpi_gbl_FADT.smi_command, value, 8);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700335 break;
336
Linus Torvalds1da177e2005-04-16 15:20:36 -0700337 default:
Bob Moorec520aba2009-02-18 14:20:12 +0800338 ACPI_ERROR((AE_INFO, "Unknown Register ID: %X", register_id));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700339 status = AE_BAD_PARAMETER;
340 break;
341 }
342
Alexey Starikovskiyd30dc9ab2007-09-30 22:39:36 +0400343 exit:
Len Brown4be44fc2005-08-05 00:44:28 -0400344 return_ACPI_STATUS(status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345}
Bob Moorec520aba2009-02-18 14:20:12 +0800346
347/******************************************************************************
348 *
349 * FUNCTION: acpi_hw_read_multiple
350 *
351 * PARAMETERS: Value - Where the register value is returned
352 * register_a - First ACPI register (required)
353 * register_b - Second ACPI register (optional)
354 *
355 * RETURN: Status
356 *
357 * DESCRIPTION: Read from the specified two-part ACPI register (such as PM1 A/B)
358 *
359 ******************************************************************************/
360
361static acpi_status
362acpi_hw_read_multiple(u32 *value,
363 struct acpi_generic_address *register_a,
364 struct acpi_generic_address *register_b)
365{
366 u32 value_a = 0;
367 u32 value_b = 0;
368 acpi_status status;
369
370 /* The first register is always required */
371
372 status = acpi_read(&value_a, register_a);
373 if (ACPI_FAILURE(status)) {
374 return (status);
375 }
376
377 /* Second register is optional */
378
379 if (register_b->address) {
380 status = acpi_read(&value_b, register_b);
381 if (ACPI_FAILURE(status)) {
382 return (status);
383 }
384 }
385
386 /* Shift the B bits above the A bits */
387
388 *value = value_a | (value_b << register_a->bit_width);
389 return (AE_OK);
390}
391
392/******************************************************************************
393 *
394 * FUNCTION: acpi_hw_write_multiple
395 *
396 * PARAMETERS: Value - The value to write
397 * register_a - First ACPI register (required)
398 * register_b - Second ACPI register (optional)
399 *
400 * RETURN: Status
401 *
402 * DESCRIPTION: Write to the specified two-part ACPI register (such as PM1 A/B)
403 *
404 ******************************************************************************/
405
406static acpi_status
407acpi_hw_write_multiple(u32 value,
408 struct acpi_generic_address *register_a,
409 struct acpi_generic_address *register_b)
410{
411 acpi_status status;
412
413 /* The first register is always required */
414
415 status = acpi_write(value, register_a);
416 if (ACPI_FAILURE(status)) {
417 return (status);
418 }
419
420 /* Second register is optional */
421
422 if (register_b->address) {
423
424 /* Normalize the B bits before write */
425
426 status = acpi_write(value >> register_a->bit_width, register_b);
427 }
428
429 return (status);
430}