hwregs.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850
  1. /*******************************************************************************
  2. *
  3. * Module Name: hwregs - Read/write access functions for the various ACPI
  4. * control and status registers.
  5. *
  6. ******************************************************************************/
  7. /*
  8. * Copyright (C) 2000 - 2005, R. Byron Moore
  9. * All rights reserved.
  10. *
  11. * Redistribution and use in source and binary forms, with or without
  12. * modification, are permitted provided that the following conditions
  13. * are met:
  14. * 1. Redistributions of source code must retain the above copyright
  15. * notice, this list of conditions, and the following disclaimer,
  16. * without modification.
  17. * 2. Redistributions in binary form must reproduce at minimum a disclaimer
  18. * substantially similar to the "NO WARRANTY" disclaimer below
  19. * ("Disclaimer") and any redistribution must be conditioned upon
  20. * including a substantially similar Disclaimer requirement for further
  21. * binary redistribution.
  22. * 3. Neither the names of the above-listed copyright holders nor the names
  23. * of any contributors may be used to endorse or promote products derived
  24. * from this software without specific prior written permission.
  25. *
  26. * Alternatively, this software may be distributed under the terms of the
  27. * GNU General Public License ("GPL") version 2 as published by the Free
  28. * Software Foundation.
  29. *
  30. * NO WARRANTY
  31. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  32. * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  33. * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
  34. * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  35. * HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  36. * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  37. * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  38. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
  39. * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
  40. * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  41. * POSSIBILITY OF SUCH DAMAGES.
  42. */
  43. #include <linux/module.h>
  44. #include <acpi/acpi.h>
  45. #include <acpi/acnamesp.h>
  46. #include <acpi/acevents.h>
  47. #define _COMPONENT ACPI_HARDWARE
  48. ACPI_MODULE_NAME ("hwregs")
  49. /*******************************************************************************
  50. *
  51. * FUNCTION: acpi_hw_clear_acpi_status
  52. *
  53. * PARAMETERS: Flags - Lock the hardware or not
  54. *
  55. * RETURN: none
  56. *
  57. * DESCRIPTION: Clears all fixed and general purpose status bits
  58. * THIS FUNCTION MUST BE CALLED WITH INTERRUPTS DISABLED
  59. *
  60. ******************************************************************************/
  61. acpi_status
  62. acpi_hw_clear_acpi_status (
  63. u32 flags)
  64. {
  65. acpi_status status;
  66. ACPI_FUNCTION_TRACE ("hw_clear_acpi_status");
  67. ACPI_DEBUG_PRINT ((ACPI_DB_IO, "About to write %04X to %04X\n",
  68. ACPI_BITMASK_ALL_FIXED_STATUS,
  69. (u16) acpi_gbl_FADT->xpm1a_evt_blk.address));
  70. if (flags & ACPI_MTX_LOCK) {
  71. status = acpi_ut_acquire_mutex (ACPI_MTX_HARDWARE);
  72. if (ACPI_FAILURE (status)) {
  73. return_ACPI_STATUS (status);
  74. }
  75. }
  76. status = acpi_hw_register_write (ACPI_MTX_DO_NOT_LOCK, ACPI_REGISTER_PM1_STATUS,
  77. ACPI_BITMASK_ALL_FIXED_STATUS);
  78. if (ACPI_FAILURE (status)) {
  79. goto unlock_and_exit;
  80. }
  81. /* Clear the fixed events */
  82. if (acpi_gbl_FADT->xpm1b_evt_blk.address) {
  83. status = acpi_hw_low_level_write (16, ACPI_BITMASK_ALL_FIXED_STATUS,
  84. &acpi_gbl_FADT->xpm1b_evt_blk);
  85. if (ACPI_FAILURE (status)) {
  86. goto unlock_and_exit;
  87. }
  88. }
  89. /* Clear the GPE Bits in all GPE registers in all GPE blocks */
  90. status = acpi_ev_walk_gpe_list (acpi_hw_clear_gpe_block, ACPI_ISR);
  91. unlock_and_exit:
  92. if (flags & ACPI_MTX_LOCK) {
  93. (void) acpi_ut_release_mutex (ACPI_MTX_HARDWARE);
  94. }
  95. return_ACPI_STATUS (status);
  96. }
  97. /*******************************************************************************
  98. *
  99. * FUNCTION: acpi_get_sleep_type_data
  100. *
  101. * PARAMETERS: sleep_state - Numeric sleep state
  102. * *sleep_type_a - Where SLP_TYPa is returned
  103. * *sleep_type_b - Where SLP_TYPb is returned
  104. *
  105. * RETURN: Status - ACPI status
  106. *
  107. * DESCRIPTION: Obtain the SLP_TYPa and SLP_TYPb values for the requested sleep
  108. * state.
  109. *
  110. ******************************************************************************/
  111. acpi_status
  112. acpi_get_sleep_type_data (
  113. u8 sleep_state,
  114. u8 *sleep_type_a,
  115. u8 *sleep_type_b)
  116. {
  117. acpi_status status = AE_OK;
  118. struct acpi_parameter_info info;
  119. ACPI_FUNCTION_TRACE ("acpi_get_sleep_type_data");
  120. /*
  121. * Validate parameters
  122. */
  123. if ((sleep_state > ACPI_S_STATES_MAX) ||
  124. !sleep_type_a || !sleep_type_b) {
  125. return_ACPI_STATUS (AE_BAD_PARAMETER);
  126. }
  127. /*
  128. * Evaluate the namespace object containing the values for this state
  129. */
  130. info.parameters = NULL;
  131. status = acpi_ns_evaluate_by_name ((char *) acpi_gbl_sleep_state_names[sleep_state],
  132. &info);
  133. if (ACPI_FAILURE (status)) {
  134. ACPI_DEBUG_PRINT ((ACPI_DB_EXEC, "%s while evaluating sleep_state [%s]\n",
  135. acpi_format_exception (status), acpi_gbl_sleep_state_names[sleep_state]));
  136. return_ACPI_STATUS (status);
  137. }
  138. /* Must have a return object */
  139. if (!info.return_object) {
  140. ACPI_REPORT_ERROR (("Missing Sleep State object\n"));
  141. status = AE_NOT_EXIST;
  142. }
  143. /* It must be of type Package */
  144. else if (ACPI_GET_OBJECT_TYPE (info.return_object) != ACPI_TYPE_PACKAGE) {
  145. ACPI_REPORT_ERROR (("Sleep State object not a Package\n"));
  146. status = AE_AML_OPERAND_TYPE;
  147. }
  148. /* The package must have at least two elements */
  149. else if (info.return_object->package.count < 2) {
  150. ACPI_REPORT_ERROR (("Sleep State package does not have at least two elements\n"));
  151. status = AE_AML_NO_OPERAND;
  152. }
  153. /* The first two elements must both be of type Integer */
  154. else if ((ACPI_GET_OBJECT_TYPE (info.return_object->package.elements[0]) != ACPI_TYPE_INTEGER) ||
  155. (ACPI_GET_OBJECT_TYPE (info.return_object->package.elements[1]) != ACPI_TYPE_INTEGER)) {
  156. ACPI_REPORT_ERROR (("Sleep State package elements are not both Integers (%s, %s)\n",
  157. acpi_ut_get_object_type_name (info.return_object->package.elements[0]),
  158. acpi_ut_get_object_type_name (info.return_object->package.elements[1])));
  159. status = AE_AML_OPERAND_TYPE;
  160. }
  161. else {
  162. /*
  163. * Valid _Sx_ package size, type, and value
  164. */
  165. *sleep_type_a = (u8) (info.return_object->package.elements[0])->integer.value;
  166. *sleep_type_b = (u8) (info.return_object->package.elements[1])->integer.value;
  167. }
  168. if (ACPI_FAILURE (status)) {
  169. ACPI_DEBUG_PRINT ((ACPI_DB_ERROR,
  170. "While evaluating sleep_state [%s], bad Sleep object %p type %s\n",
  171. acpi_gbl_sleep_state_names[sleep_state], info.return_object,
  172. acpi_ut_get_object_type_name (info.return_object)));
  173. }
  174. acpi_ut_remove_reference (info.return_object);
  175. return_ACPI_STATUS (status);
  176. }
  177. EXPORT_SYMBOL(acpi_get_sleep_type_data);
  178. /*******************************************************************************
  179. *
  180. * FUNCTION: acpi_hw_get_register_bit_mask
  181. *
  182. * PARAMETERS: register_id - Index of ACPI Register to access
  183. *
  184. * RETURN: The bit mask to be used when accessing the register
  185. *
  186. * DESCRIPTION: Map register_id into a register bit mask.
  187. *
  188. ******************************************************************************/
  189. struct acpi_bit_register_info *
  190. acpi_hw_get_bit_register_info (
  191. u32 register_id)
  192. {
  193. ACPI_FUNCTION_NAME ("hw_get_bit_register_info");
  194. if (register_id > ACPI_BITREG_MAX) {
  195. ACPI_DEBUG_PRINT ((ACPI_DB_ERROR, "Invalid bit_register ID: %X\n", register_id));
  196. return (NULL);
  197. }
  198. return (&acpi_gbl_bit_register_info[register_id]);
  199. }
  200. /*******************************************************************************
  201. *
  202. * FUNCTION: acpi_get_register
  203. *
  204. * PARAMETERS: register_id - ID of ACPI bit_register to access
  205. * return_value - Value that was read from the register
  206. * Flags - Lock the hardware or not
  207. *
  208. * RETURN: Status and the value read from specified Register. Value
  209. * returned is normalized to bit0 (is shifted all the way right)
  210. *
  211. * DESCRIPTION: ACPI bit_register read function.
  212. *
  213. ******************************************************************************/
  214. acpi_status
  215. acpi_get_register (
  216. u32 register_id,
  217. u32 *return_value,
  218. u32 flags)
  219. {
  220. u32 register_value = 0;
  221. struct acpi_bit_register_info *bit_reg_info;
  222. acpi_status status;
  223. ACPI_FUNCTION_TRACE ("acpi_get_register");
  224. /* Get the info structure corresponding to the requested ACPI Register */
  225. bit_reg_info = acpi_hw_get_bit_register_info (register_id);
  226. if (!bit_reg_info) {
  227. return_ACPI_STATUS (AE_BAD_PARAMETER);
  228. }
  229. if (flags & ACPI_MTX_LOCK) {
  230. status = acpi_ut_acquire_mutex (ACPI_MTX_HARDWARE);
  231. if (ACPI_FAILURE (status)) {
  232. return_ACPI_STATUS (status);
  233. }
  234. }
  235. /* Read from the register */
  236. status = acpi_hw_register_read (ACPI_MTX_DO_NOT_LOCK,
  237. bit_reg_info->parent_register, &register_value);
  238. if (flags & ACPI_MTX_LOCK) {
  239. (void) acpi_ut_release_mutex (ACPI_MTX_HARDWARE);
  240. }
  241. if (ACPI_SUCCESS (status)) {
  242. /* Normalize the value that was read */
  243. register_value = ((register_value & bit_reg_info->access_bit_mask)
  244. >> bit_reg_info->bit_position);
  245. *return_value = register_value;
  246. ACPI_DEBUG_PRINT ((ACPI_DB_IO, "Read value %8.8X register %X\n",
  247. register_value, bit_reg_info->parent_register));
  248. }
  249. return_ACPI_STATUS (status);
  250. }
  251. EXPORT_SYMBOL(acpi_get_register);
  252. /*******************************************************************************
  253. *
  254. * FUNCTION: acpi_set_register
  255. *
  256. * PARAMETERS: register_id - ID of ACPI bit_register to access
  257. * Value - (only used on write) value to write to the
  258. * Register, NOT pre-normalized to the bit pos
  259. * Flags - Lock the hardware or not
  260. *
  261. * RETURN: Status
  262. *
  263. * DESCRIPTION: ACPI Bit Register write function.
  264. *
  265. ******************************************************************************/
  266. acpi_status
  267. acpi_set_register (
  268. u32 register_id,
  269. u32 value,
  270. u32 flags)
  271. {
  272. u32 register_value = 0;
  273. struct acpi_bit_register_info *bit_reg_info;
  274. acpi_status status;
  275. ACPI_FUNCTION_TRACE_U32 ("acpi_set_register", register_id);
  276. /* Get the info structure corresponding to the requested ACPI Register */
  277. bit_reg_info = acpi_hw_get_bit_register_info (register_id);
  278. if (!bit_reg_info) {
  279. ACPI_REPORT_ERROR (("Bad ACPI HW register_id: %X\n", register_id));
  280. return_ACPI_STATUS (AE_BAD_PARAMETER);
  281. }
  282. if (flags & ACPI_MTX_LOCK) {
  283. status = acpi_ut_acquire_mutex (ACPI_MTX_HARDWARE);
  284. if (ACPI_FAILURE (status)) {
  285. return_ACPI_STATUS (status);
  286. }
  287. }
  288. /* Always do a register read first so we can insert the new bits */
  289. status = acpi_hw_register_read (ACPI_MTX_DO_NOT_LOCK,
  290. bit_reg_info->parent_register, &register_value);
  291. if (ACPI_FAILURE (status)) {
  292. goto unlock_and_exit;
  293. }
  294. /*
  295. * Decode the Register ID
  296. * Register ID = [Register block ID] | [bit ID]
  297. *
  298. * Check bit ID to fine locate Register offset.
  299. * Check Mask to determine Register offset, and then read-write.
  300. */
  301. switch (bit_reg_info->parent_register) {
  302. case ACPI_REGISTER_PM1_STATUS:
  303. /*
  304. * Status Registers are different from the rest. Clear by
  305. * writing 1, and writing 0 has no effect. So, the only relevant
  306. * information is the single bit we're interested in, all others should
  307. * be written as 0 so they will be left unchanged.
  308. */
  309. value = ACPI_REGISTER_PREPARE_BITS (value,
  310. bit_reg_info->bit_position, bit_reg_info->access_bit_mask);
  311. if (value) {
  312. status = acpi_hw_register_write (ACPI_MTX_DO_NOT_LOCK,
  313. ACPI_REGISTER_PM1_STATUS, (u16) value);
  314. register_value = 0;
  315. }
  316. break;
  317. case ACPI_REGISTER_PM1_ENABLE:
  318. ACPI_REGISTER_INSERT_VALUE (register_value, bit_reg_info->bit_position,
  319. bit_reg_info->access_bit_mask, value);
  320. status = acpi_hw_register_write (ACPI_MTX_DO_NOT_LOCK,
  321. ACPI_REGISTER_PM1_ENABLE, (u16) register_value);
  322. break;
  323. case ACPI_REGISTER_PM1_CONTROL:
  324. /*
  325. * Write the PM1 Control register.
  326. * Note that at this level, the fact that there are actually TWO
  327. * registers (A and B - and B may not exist) is abstracted.
  328. */
  329. ACPI_DEBUG_PRINT ((ACPI_DB_IO, "PM1 control: Read %X\n", register_value));
  330. ACPI_REGISTER_INSERT_VALUE (register_value, bit_reg_info->bit_position,
  331. bit_reg_info->access_bit_mask, value);
  332. status = acpi_hw_register_write (ACPI_MTX_DO_NOT_LOCK,
  333. ACPI_REGISTER_PM1_CONTROL, (u16) register_value);
  334. break;
  335. case ACPI_REGISTER_PM2_CONTROL:
  336. status = acpi_hw_register_read (ACPI_MTX_DO_NOT_LOCK,
  337. ACPI_REGISTER_PM2_CONTROL, &register_value);
  338. if (ACPI_FAILURE (status)) {
  339. goto unlock_and_exit;
  340. }
  341. ACPI_DEBUG_PRINT ((ACPI_DB_IO, "PM2 control: Read %X from %8.8X%8.8X\n",
  342. register_value,
  343. ACPI_FORMAT_UINT64 (acpi_gbl_FADT->xpm2_cnt_blk.address)));
  344. ACPI_REGISTER_INSERT_VALUE (register_value, bit_reg_info->bit_position,
  345. bit_reg_info->access_bit_mask, value);
  346. ACPI_DEBUG_PRINT ((ACPI_DB_IO, "About to write %4.4X to %8.8X%8.8X\n",
  347. register_value,
  348. ACPI_FORMAT_UINT64 (acpi_gbl_FADT->xpm2_cnt_blk.address)));
  349. status = acpi_hw_register_write (ACPI_MTX_DO_NOT_LOCK,
  350. ACPI_REGISTER_PM2_CONTROL, (u8) (register_value));
  351. break;
  352. default:
  353. break;
  354. }
  355. unlock_and_exit:
  356. if (flags & ACPI_MTX_LOCK) {
  357. (void) acpi_ut_release_mutex (ACPI_MTX_HARDWARE);
  358. }
  359. /* Normalize the value that was read */
  360. ACPI_DEBUG_EXEC (register_value = ((register_value & bit_reg_info->access_bit_mask) >> bit_reg_info->bit_position));
  361. ACPI_DEBUG_PRINT ((ACPI_DB_IO, "Set bits: %8.8X actual %8.8X register %X\n",
  362. value, register_value, bit_reg_info->parent_register));
  363. return_ACPI_STATUS (status);
  364. }
  365. EXPORT_SYMBOL(acpi_set_register);
  366. /******************************************************************************
  367. *
  368. * FUNCTION: acpi_hw_register_read
  369. *
  370. * PARAMETERS: use_lock - Mutex hw access
  371. * register_id - register_iD + Offset
  372. * return_value - Value that was read from the register
  373. *
  374. * RETURN: Status and the value read.
  375. *
  376. * DESCRIPTION: Acpi register read function. Registers are read at the
  377. * given offset.
  378. *
  379. ******************************************************************************/
  380. acpi_status
  381. acpi_hw_register_read (
  382. u8 use_lock,
  383. u32 register_id,
  384. u32 *return_value)
  385. {
  386. u32 value1 = 0;
  387. u32 value2 = 0;
  388. acpi_status status;
  389. ACPI_FUNCTION_TRACE ("hw_register_read");
  390. if (ACPI_MTX_LOCK == use_lock) {
  391. status = acpi_ut_acquire_mutex (ACPI_MTX_HARDWARE);
  392. if (ACPI_FAILURE (status)) {
  393. return_ACPI_STATUS (status);
  394. }
  395. }
  396. switch (register_id) {
  397. case ACPI_REGISTER_PM1_STATUS: /* 16-bit access */
  398. status = acpi_hw_low_level_read (16, &value1, &acpi_gbl_FADT->xpm1a_evt_blk);
  399. if (ACPI_FAILURE (status)) {
  400. goto unlock_and_exit;
  401. }
  402. /* PM1B is optional */
  403. status = acpi_hw_low_level_read (16, &value2, &acpi_gbl_FADT->xpm1b_evt_blk);
  404. value1 |= value2;
  405. break;
  406. case ACPI_REGISTER_PM1_ENABLE: /* 16-bit access */
  407. status = acpi_hw_low_level_read (16, &value1, &acpi_gbl_xpm1a_enable);
  408. if (ACPI_FAILURE (status)) {
  409. goto unlock_and_exit;
  410. }
  411. /* PM1B is optional */
  412. status = acpi_hw_low_level_read (16, &value2, &acpi_gbl_xpm1b_enable);
  413. value1 |= value2;
  414. break;
  415. case ACPI_REGISTER_PM1_CONTROL: /* 16-bit access */
  416. status = acpi_hw_low_level_read (16, &value1, &acpi_gbl_FADT->xpm1a_cnt_blk);
  417. if (ACPI_FAILURE (status)) {
  418. goto unlock_and_exit;
  419. }
  420. status = acpi_hw_low_level_read (16, &value2, &acpi_gbl_FADT->xpm1b_cnt_blk);
  421. value1 |= value2;
  422. break;
  423. case ACPI_REGISTER_PM2_CONTROL: /* 8-bit access */
  424. status = acpi_hw_low_level_read (8, &value1, &acpi_gbl_FADT->xpm2_cnt_blk);
  425. break;
  426. case ACPI_REGISTER_PM_TIMER: /* 32-bit access */
  427. status = acpi_hw_low_level_read (32, &value1, &acpi_gbl_FADT->xpm_tmr_blk);
  428. break;
  429. case ACPI_REGISTER_SMI_COMMAND_BLOCK: /* 8-bit access */
  430. status = acpi_os_read_port (acpi_gbl_FADT->smi_cmd, &value1, 8);
  431. break;
  432. default:
  433. ACPI_DEBUG_PRINT ((ACPI_DB_ERROR, "Unknown Register ID: %X\n", register_id));
  434. status = AE_BAD_PARAMETER;
  435. break;
  436. }
  437. unlock_and_exit:
  438. if (ACPI_MTX_LOCK == use_lock) {
  439. (void) acpi_ut_release_mutex (ACPI_MTX_HARDWARE);
  440. }
  441. if (ACPI_SUCCESS (status)) {
  442. *return_value = value1;
  443. }
  444. return_ACPI_STATUS (status);
  445. }
  446. /******************************************************************************
  447. *
  448. * FUNCTION: acpi_hw_register_write
  449. *
  450. * PARAMETERS: use_lock - Mutex hw access
  451. * register_id - register_iD + Offset
  452. * Value - The value to write
  453. *
  454. * RETURN: Status
  455. *
  456. * DESCRIPTION: Acpi register Write function. Registers are written at the
  457. * given offset.
  458. *
  459. ******************************************************************************/
  460. acpi_status
  461. acpi_hw_register_write (
  462. u8 use_lock,
  463. u32 register_id,
  464. u32 value)
  465. {
  466. acpi_status status;
  467. ACPI_FUNCTION_TRACE ("hw_register_write");
  468. if (ACPI_MTX_LOCK == use_lock) {
  469. status = acpi_ut_acquire_mutex (ACPI_MTX_HARDWARE);
  470. if (ACPI_FAILURE (status)) {
  471. return_ACPI_STATUS (status);
  472. }
  473. }
  474. switch (register_id) {
  475. case ACPI_REGISTER_PM1_STATUS: /* 16-bit access */
  476. status = acpi_hw_low_level_write (16, value, &acpi_gbl_FADT->xpm1a_evt_blk);
  477. if (ACPI_FAILURE (status)) {
  478. goto unlock_and_exit;
  479. }
  480. /* PM1B is optional */
  481. status = acpi_hw_low_level_write (16, value, &acpi_gbl_FADT->xpm1b_evt_blk);
  482. break;
  483. case ACPI_REGISTER_PM1_ENABLE: /* 16-bit access*/
  484. status = acpi_hw_low_level_write (16, value, &acpi_gbl_xpm1a_enable);
  485. if (ACPI_FAILURE (status)) {
  486. goto unlock_and_exit;
  487. }
  488. /* PM1B is optional */
  489. status = acpi_hw_low_level_write (16, value, &acpi_gbl_xpm1b_enable);
  490. break;
  491. case ACPI_REGISTER_PM1_CONTROL: /* 16-bit access */
  492. status = acpi_hw_low_level_write (16, value, &acpi_gbl_FADT->xpm1a_cnt_blk);
  493. if (ACPI_FAILURE (status)) {
  494. goto unlock_and_exit;
  495. }
  496. status = acpi_hw_low_level_write (16, value, &acpi_gbl_FADT->xpm1b_cnt_blk);
  497. break;
  498. case ACPI_REGISTER_PM1A_CONTROL: /* 16-bit access */
  499. status = acpi_hw_low_level_write (16, value, &acpi_gbl_FADT->xpm1a_cnt_blk);
  500. break;
  501. case ACPI_REGISTER_PM1B_CONTROL: /* 16-bit access */
  502. status = acpi_hw_low_level_write (16, value, &acpi_gbl_FADT->xpm1b_cnt_blk);
  503. break;
  504. case ACPI_REGISTER_PM2_CONTROL: /* 8-bit access */
  505. status = acpi_hw_low_level_write (8, value, &acpi_gbl_FADT->xpm2_cnt_blk);
  506. break;
  507. case ACPI_REGISTER_PM_TIMER: /* 32-bit access */
  508. status = acpi_hw_low_level_write (32, value, &acpi_gbl_FADT->xpm_tmr_blk);
  509. break;
  510. case ACPI_REGISTER_SMI_COMMAND_BLOCK: /* 8-bit access */
  511. /* SMI_CMD is currently always in IO space */
  512. status = acpi_os_write_port (acpi_gbl_FADT->smi_cmd, value, 8);
  513. break;
  514. default:
  515. status = AE_BAD_PARAMETER;
  516. break;
  517. }
  518. unlock_and_exit:
  519. if (ACPI_MTX_LOCK == use_lock) {
  520. (void) acpi_ut_release_mutex (ACPI_MTX_HARDWARE);
  521. }
  522. return_ACPI_STATUS (status);
  523. }
  524. /******************************************************************************
  525. *
  526. * FUNCTION: acpi_hw_low_level_read
  527. *
  528. * PARAMETERS: Width - 8, 16, or 32
  529. * Value - Where the value is returned
  530. * Reg - GAS register structure
  531. *
  532. * RETURN: Status
  533. *
  534. * DESCRIPTION: Read from either memory or IO space.
  535. *
  536. ******************************************************************************/
  537. acpi_status
  538. acpi_hw_low_level_read (
  539. u32 width,
  540. u32 *value,
  541. struct acpi_generic_address *reg)
  542. {
  543. u64 address;
  544. acpi_status status;
  545. ACPI_FUNCTION_NAME ("hw_low_level_read");
  546. /*
  547. * Must have a valid pointer to a GAS structure, and
  548. * a non-zero address within. However, don't return an error
  549. * because the PM1A/B code must not fail if B isn't present.
  550. */
  551. if (!reg) {
  552. return (AE_OK);
  553. }
  554. /* Get a local copy of the address. Handles possible alignment issues */
  555. ACPI_MOVE_64_TO_64 (&address, &reg->address);
  556. if (!address) {
  557. return (AE_OK);
  558. }
  559. *value = 0;
  560. /*
  561. * Two address spaces supported: Memory or IO.
  562. * PCI_Config is not supported here because the GAS struct is insufficient
  563. */
  564. switch (reg->address_space_id) {
  565. case ACPI_ADR_SPACE_SYSTEM_MEMORY:
  566. status = acpi_os_read_memory (
  567. (acpi_physical_address) address,
  568. value, width);
  569. break;
  570. case ACPI_ADR_SPACE_SYSTEM_IO:
  571. status = acpi_os_read_port ((acpi_io_address) address,
  572. value, width);
  573. break;
  574. default:
  575. ACPI_DEBUG_PRINT ((ACPI_DB_ERROR,
  576. "Unsupported address space: %X\n", reg->address_space_id));
  577. return (AE_BAD_PARAMETER);
  578. }
  579. ACPI_DEBUG_PRINT ((ACPI_DB_IO, "Read: %8.8X width %2d from %8.8X%8.8X (%s)\n",
  580. *value, width,
  581. ACPI_FORMAT_UINT64 (address),
  582. acpi_ut_get_region_name (reg->address_space_id)));
  583. return (status);
  584. }
  585. /******************************************************************************
  586. *
  587. * FUNCTION: acpi_hw_low_level_write
  588. *
  589. * PARAMETERS: Width - 8, 16, or 32
  590. * Value - To be written
  591. * Reg - GAS register structure
  592. *
  593. * RETURN: Status
  594. *
  595. * DESCRIPTION: Write to either memory or IO space.
  596. *
  597. ******************************************************************************/
  598. acpi_status
  599. acpi_hw_low_level_write (
  600. u32 width,
  601. u32 value,
  602. struct acpi_generic_address *reg)
  603. {
  604. u64 address;
  605. acpi_status status;
  606. ACPI_FUNCTION_NAME ("hw_low_level_write");
  607. /*
  608. * Must have a valid pointer to a GAS structure, and
  609. * a non-zero address within. However, don't return an error
  610. * because the PM1A/B code must not fail if B isn't present.
  611. */
  612. if (!reg) {
  613. return (AE_OK);
  614. }
  615. /* Get a local copy of the address. Handles possible alignment issues */
  616. ACPI_MOVE_64_TO_64 (&address, &reg->address);
  617. if (!address) {
  618. return (AE_OK);
  619. }
  620. /*
  621. * Two address spaces supported: Memory or IO.
  622. * PCI_Config is not supported here because the GAS struct is insufficient
  623. */
  624. switch (reg->address_space_id) {
  625. case ACPI_ADR_SPACE_SYSTEM_MEMORY:
  626. status = acpi_os_write_memory (
  627. (acpi_physical_address) address,
  628. value, width);
  629. break;
  630. case ACPI_ADR_SPACE_SYSTEM_IO:
  631. status = acpi_os_write_port ((acpi_io_address) address,
  632. value, width);
  633. break;
  634. default:
  635. ACPI_DEBUG_PRINT ((ACPI_DB_ERROR,
  636. "Unsupported address space: %X\n", reg->address_space_id));
  637. return (AE_BAD_PARAMETER);
  638. }
  639. ACPI_DEBUG_PRINT ((ACPI_DB_IO, "Wrote: %8.8X width %2d to %8.8X%8.8X (%s)\n",
  640. value, width,
  641. ACPI_FORMAT_UINT64 (address),
  642. acpi_ut_get_region_name (reg->address_space_id)));
  643. return (status);
  644. }