hwregs.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844
  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 - 2006, 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 acpi_hw_clear_acpi_status(u32 flags)
  62. {
  63. acpi_status status;
  64. ACPI_FUNCTION_TRACE("hw_clear_acpi_status");
  65. ACPI_DEBUG_PRINT((ACPI_DB_IO, "About to write %04X to %04X\n",
  66. ACPI_BITMASK_ALL_FIXED_STATUS,
  67. (u16) acpi_gbl_FADT->xpm1a_evt_blk.address));
  68. if (flags & ACPI_MTX_LOCK) {
  69. status = acpi_ut_acquire_mutex(ACPI_MTX_HARDWARE);
  70. if (ACPI_FAILURE(status)) {
  71. return_ACPI_STATUS(status);
  72. }
  73. }
  74. status = acpi_hw_register_write(ACPI_MTX_DO_NOT_LOCK,
  75. ACPI_REGISTER_PM1_STATUS,
  76. ACPI_BITMASK_ALL_FIXED_STATUS);
  77. if (ACPI_FAILURE(status)) {
  78. goto unlock_and_exit;
  79. }
  80. /* Clear the fixed events */
  81. if (acpi_gbl_FADT->xpm1b_evt_blk.address) {
  82. status =
  83. 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);
  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(u8 sleep_state, u8 * sleep_type_a, u8 * sleep_type_b)
  113. {
  114. acpi_status status = AE_OK;
  115. struct acpi_parameter_info info;
  116. char *sleep_state_name;
  117. ACPI_FUNCTION_TRACE("acpi_get_sleep_type_data");
  118. /* Validate parameters */
  119. if ((sleep_state > ACPI_S_STATES_MAX) || !sleep_type_a || !sleep_type_b) {
  120. return_ACPI_STATUS(AE_BAD_PARAMETER);
  121. }
  122. /* Evaluate the namespace object containing the values for this state */
  123. info.parameters = NULL;
  124. info.return_object = NULL;
  125. sleep_state_name =
  126. ACPI_CAST_PTR(char, acpi_gbl_sleep_state_names[sleep_state]);
  127. status = acpi_ns_evaluate_by_name(sleep_state_name, &info);
  128. if (ACPI_FAILURE(status)) {
  129. ACPI_DEBUG_PRINT((ACPI_DB_EXEC,
  130. "%s while evaluating sleep_state [%s]\n",
  131. acpi_format_exception(status),
  132. sleep_state_name));
  133. return_ACPI_STATUS(status);
  134. }
  135. /* Must have a return object */
  136. if (!info.return_object) {
  137. ACPI_REPORT_ERROR(("No Sleep State object returned from [%s]\n",
  138. sleep_state_name));
  139. status = AE_NOT_EXIST;
  140. }
  141. /* It must be of type Package */
  142. else if (ACPI_GET_OBJECT_TYPE(info.return_object) != ACPI_TYPE_PACKAGE) {
  143. ACPI_REPORT_ERROR(("Sleep State return object is not a Package\n"));
  144. status = AE_AML_OPERAND_TYPE;
  145. }
  146. /*
  147. * The package must have at least two elements. NOTE (March 2005): This
  148. * goes against the current ACPI spec which defines this object as a
  149. * package with one encoded DWORD element. However, existing practice
  150. * by BIOS vendors seems to be to have 2 or more elements, at least
  151. * one per sleep type (A/B).
  152. */
  153. else if (info.return_object->package.count < 2) {
  154. ACPI_REPORT_ERROR(("Sleep State return package does not have at least two elements\n"));
  155. status = AE_AML_NO_OPERAND;
  156. }
  157. /* The first two elements must both be of type Integer */
  158. else if ((ACPI_GET_OBJECT_TYPE(info.return_object->package.elements[0])
  159. != ACPI_TYPE_INTEGER) ||
  160. (ACPI_GET_OBJECT_TYPE(info.return_object->package.elements[1])
  161. != ACPI_TYPE_INTEGER)) {
  162. ACPI_REPORT_ERROR(("Sleep State return package elements are not both Integers (%s, %s)\n", acpi_ut_get_object_type_name(info.return_object->package.elements[0]), acpi_ut_get_object_type_name(info.return_object->package.elements[1])));
  163. status = AE_AML_OPERAND_TYPE;
  164. } else {
  165. /* Valid _Sx_ package size, type, and value */
  166. *sleep_type_a = (u8)
  167. (info.return_object->package.elements[0])->integer.value;
  168. *sleep_type_b = (u8)
  169. (info.return_object->package.elements[1])->integer.value;
  170. }
  171. if (ACPI_FAILURE(status)) {
  172. ACPI_REPORT_ERROR(("%s While evaluating sleep_state [%s], bad Sleep object %p type %s\n", acpi_format_exception(status), sleep_state_name, info.return_object, 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 bitmask to be used when accessing the register
  185. *
  186. * DESCRIPTION: Map register_id into a register bitmask.
  187. *
  188. ******************************************************************************/
  189. struct acpi_bit_register_info *acpi_hw_get_bit_register_info(u32 register_id)
  190. {
  191. ACPI_FUNCTION_ENTRY();
  192. if (register_id > ACPI_BITREG_MAX) {
  193. ACPI_REPORT_ERROR(("Invalid bit_register ID: %X\n",
  194. register_id));
  195. return (NULL);
  196. }
  197. return (&acpi_gbl_bit_register_info[register_id]);
  198. }
  199. /*******************************************************************************
  200. *
  201. * FUNCTION: acpi_get_register
  202. *
  203. * PARAMETERS: register_id - ID of ACPI bit_register to access
  204. * return_value - Value that was read from the register
  205. * Flags - Lock the hardware or not
  206. *
  207. * RETURN: Status and the value read from specified Register. Value
  208. * returned is normalized to bit0 (is shifted all the way right)
  209. *
  210. * DESCRIPTION: ACPI bit_register read function.
  211. *
  212. ******************************************************************************/
  213. acpi_status acpi_get_register(u32 register_id, u32 * return_value, u32 flags)
  214. {
  215. u32 register_value = 0;
  216. struct acpi_bit_register_info *bit_reg_info;
  217. acpi_status status;
  218. ACPI_FUNCTION_TRACE("acpi_get_register");
  219. /* Get the info structure corresponding to the requested ACPI Register */
  220. bit_reg_info = acpi_hw_get_bit_register_info(register_id);
  221. if (!bit_reg_info) {
  222. return_ACPI_STATUS(AE_BAD_PARAMETER);
  223. }
  224. if (flags & ACPI_MTX_LOCK) {
  225. status = acpi_ut_acquire_mutex(ACPI_MTX_HARDWARE);
  226. if (ACPI_FAILURE(status)) {
  227. return_ACPI_STATUS(status);
  228. }
  229. }
  230. /* Read from the register */
  231. status = acpi_hw_register_read(ACPI_MTX_DO_NOT_LOCK,
  232. bit_reg_info->parent_register,
  233. &register_value);
  234. if (flags & ACPI_MTX_LOCK) {
  235. (void)acpi_ut_release_mutex(ACPI_MTX_HARDWARE);
  236. }
  237. if (ACPI_SUCCESS(status)) {
  238. /* Normalize the value that was read */
  239. register_value =
  240. ((register_value & bit_reg_info->access_bit_mask)
  241. >> bit_reg_info->bit_position);
  242. *return_value = register_value;
  243. ACPI_DEBUG_PRINT((ACPI_DB_IO, "Read value %8.8X register %X\n",
  244. register_value,
  245. bit_reg_info->parent_register));
  246. }
  247. return_ACPI_STATUS(status);
  248. }
  249. EXPORT_SYMBOL(acpi_get_register);
  250. /*******************************************************************************
  251. *
  252. * FUNCTION: acpi_set_register
  253. *
  254. * PARAMETERS: register_id - ID of ACPI bit_register to access
  255. * Value - (only used on write) value to write to the
  256. * Register, NOT pre-normalized to the bit pos
  257. * Flags - Lock the hardware or not
  258. *
  259. * RETURN: Status
  260. *
  261. * DESCRIPTION: ACPI Bit Register write function.
  262. *
  263. ******************************************************************************/
  264. acpi_status acpi_set_register(u32 register_id, u32 value, u32 flags)
  265. {
  266. u32 register_value = 0;
  267. struct acpi_bit_register_info *bit_reg_info;
  268. acpi_status status;
  269. ACPI_FUNCTION_TRACE_U32("acpi_set_register", register_id);
  270. /* Get the info structure corresponding to the requested ACPI Register */
  271. bit_reg_info = acpi_hw_get_bit_register_info(register_id);
  272. if (!bit_reg_info) {
  273. ACPI_REPORT_ERROR(("Bad ACPI HW register_id: %X\n",
  274. register_id));
  275. return_ACPI_STATUS(AE_BAD_PARAMETER);
  276. }
  277. if (flags & ACPI_MTX_LOCK) {
  278. status = acpi_ut_acquire_mutex(ACPI_MTX_HARDWARE);
  279. if (ACPI_FAILURE(status)) {
  280. return_ACPI_STATUS(status);
  281. }
  282. }
  283. /* Always do a register read first so we can insert the new bits */
  284. status = acpi_hw_register_read(ACPI_MTX_DO_NOT_LOCK,
  285. bit_reg_info->parent_register,
  286. &register_value);
  287. if (ACPI_FAILURE(status)) {
  288. goto unlock_and_exit;
  289. }
  290. /*
  291. * Decode the Register ID
  292. * Register ID = [Register block ID] | [bit ID]
  293. *
  294. * Check bit ID to fine locate Register offset.
  295. * Check Mask to determine Register offset, and then read-write.
  296. */
  297. switch (bit_reg_info->parent_register) {
  298. case ACPI_REGISTER_PM1_STATUS:
  299. /*
  300. * Status Registers are different from the rest. Clear by
  301. * writing 1, and writing 0 has no effect. So, the only relevant
  302. * information is the single bit we're interested in, all others should
  303. * be written as 0 so they will be left unchanged.
  304. */
  305. value = ACPI_REGISTER_PREPARE_BITS(value,
  306. bit_reg_info->bit_position,
  307. bit_reg_info->
  308. access_bit_mask);
  309. if (value) {
  310. status = acpi_hw_register_write(ACPI_MTX_DO_NOT_LOCK,
  311. ACPI_REGISTER_PM1_STATUS,
  312. (u16) value);
  313. register_value = 0;
  314. }
  315. break;
  316. case ACPI_REGISTER_PM1_ENABLE:
  317. ACPI_REGISTER_INSERT_VALUE(register_value,
  318. bit_reg_info->bit_position,
  319. bit_reg_info->access_bit_mask,
  320. value);
  321. status = acpi_hw_register_write(ACPI_MTX_DO_NOT_LOCK,
  322. ACPI_REGISTER_PM1_ENABLE,
  323. (u16) register_value);
  324. break;
  325. case ACPI_REGISTER_PM1_CONTROL:
  326. /*
  327. * Write the PM1 Control register.
  328. * Note that at this level, the fact that there are actually TWO
  329. * registers (A and B - and B may not exist) is abstracted.
  330. */
  331. ACPI_DEBUG_PRINT((ACPI_DB_IO, "PM1 control: Read %X\n",
  332. register_value));
  333. ACPI_REGISTER_INSERT_VALUE(register_value,
  334. bit_reg_info->bit_position,
  335. bit_reg_info->access_bit_mask,
  336. value);
  337. status = acpi_hw_register_write(ACPI_MTX_DO_NOT_LOCK,
  338. ACPI_REGISTER_PM1_CONTROL,
  339. (u16) register_value);
  340. break;
  341. case ACPI_REGISTER_PM2_CONTROL:
  342. status = acpi_hw_register_read(ACPI_MTX_DO_NOT_LOCK,
  343. ACPI_REGISTER_PM2_CONTROL,
  344. &register_value);
  345. if (ACPI_FAILURE(status)) {
  346. goto unlock_and_exit;
  347. }
  348. ACPI_DEBUG_PRINT((ACPI_DB_IO,
  349. "PM2 control: Read %X from %8.8X%8.8X\n",
  350. register_value,
  351. ACPI_FORMAT_UINT64(acpi_gbl_FADT->
  352. xpm2_cnt_blk.address)));
  353. ACPI_REGISTER_INSERT_VALUE(register_value,
  354. bit_reg_info->bit_position,
  355. bit_reg_info->access_bit_mask,
  356. value);
  357. ACPI_DEBUG_PRINT((ACPI_DB_IO,
  358. "About to write %4.4X to %8.8X%8.8X\n",
  359. register_value,
  360. ACPI_FORMAT_UINT64(acpi_gbl_FADT->
  361. xpm2_cnt_blk.address)));
  362. status = acpi_hw_register_write(ACPI_MTX_DO_NOT_LOCK,
  363. ACPI_REGISTER_PM2_CONTROL,
  364. (u8) (register_value));
  365. break;
  366. default:
  367. break;
  368. }
  369. unlock_and_exit:
  370. if (flags & ACPI_MTX_LOCK) {
  371. (void)acpi_ut_release_mutex(ACPI_MTX_HARDWARE);
  372. }
  373. /* Normalize the value that was read */
  374. ACPI_DEBUG_EXEC(register_value =
  375. ((register_value & bit_reg_info->access_bit_mask) >>
  376. bit_reg_info->bit_position));
  377. ACPI_DEBUG_PRINT((ACPI_DB_IO,
  378. "Set bits: %8.8X actual %8.8X register %X\n", value,
  379. register_value, bit_reg_info->parent_register));
  380. return_ACPI_STATUS(status);
  381. }
  382. EXPORT_SYMBOL(acpi_set_register);
  383. /******************************************************************************
  384. *
  385. * FUNCTION: acpi_hw_register_read
  386. *
  387. * PARAMETERS: use_lock - Mutex hw access
  388. * register_id - register_iD + Offset
  389. * return_value - Where the register value is returned
  390. *
  391. * RETURN: Status and the value read.
  392. *
  393. * DESCRIPTION: Acpi register read function. Registers are read at the
  394. * given offset.
  395. *
  396. ******************************************************************************/
  397. acpi_status
  398. acpi_hw_register_read(u8 use_lock, u32 register_id, u32 * return_value)
  399. {
  400. u32 value1 = 0;
  401. u32 value2 = 0;
  402. acpi_status status;
  403. ACPI_FUNCTION_TRACE("hw_register_read");
  404. if (ACPI_MTX_LOCK == use_lock) {
  405. status = acpi_ut_acquire_mutex(ACPI_MTX_HARDWARE);
  406. if (ACPI_FAILURE(status)) {
  407. return_ACPI_STATUS(status);
  408. }
  409. }
  410. switch (register_id) {
  411. case ACPI_REGISTER_PM1_STATUS: /* 16-bit access */
  412. status =
  413. acpi_hw_low_level_read(16, &value1,
  414. &acpi_gbl_FADT->xpm1a_evt_blk);
  415. if (ACPI_FAILURE(status)) {
  416. goto unlock_and_exit;
  417. }
  418. /* PM1B is optional */
  419. status =
  420. acpi_hw_low_level_read(16, &value2,
  421. &acpi_gbl_FADT->xpm1b_evt_blk);
  422. value1 |= value2;
  423. break;
  424. case ACPI_REGISTER_PM1_ENABLE: /* 16-bit access */
  425. status =
  426. acpi_hw_low_level_read(16, &value1, &acpi_gbl_xpm1a_enable);
  427. if (ACPI_FAILURE(status)) {
  428. goto unlock_and_exit;
  429. }
  430. /* PM1B is optional */
  431. status =
  432. acpi_hw_low_level_read(16, &value2, &acpi_gbl_xpm1b_enable);
  433. value1 |= value2;
  434. break;
  435. case ACPI_REGISTER_PM1_CONTROL: /* 16-bit access */
  436. status =
  437. acpi_hw_low_level_read(16, &value1,
  438. &acpi_gbl_FADT->xpm1a_cnt_blk);
  439. if (ACPI_FAILURE(status)) {
  440. goto unlock_and_exit;
  441. }
  442. status =
  443. acpi_hw_low_level_read(16, &value2,
  444. &acpi_gbl_FADT->xpm1b_cnt_blk);
  445. value1 |= value2;
  446. break;
  447. case ACPI_REGISTER_PM2_CONTROL: /* 8-bit access */
  448. status =
  449. acpi_hw_low_level_read(8, &value1,
  450. &acpi_gbl_FADT->xpm2_cnt_blk);
  451. break;
  452. case ACPI_REGISTER_PM_TIMER: /* 32-bit access */
  453. status =
  454. acpi_hw_low_level_read(32, &value1,
  455. &acpi_gbl_FADT->xpm_tmr_blk);
  456. break;
  457. case ACPI_REGISTER_SMI_COMMAND_BLOCK: /* 8-bit access */
  458. status = acpi_os_read_port(acpi_gbl_FADT->smi_cmd, &value1, 8);
  459. break;
  460. default:
  461. ACPI_REPORT_ERROR(("Unknown Register ID: %X\n", register_id));
  462. status = AE_BAD_PARAMETER;
  463. break;
  464. }
  465. unlock_and_exit:
  466. if (ACPI_MTX_LOCK == use_lock) {
  467. (void)acpi_ut_release_mutex(ACPI_MTX_HARDWARE);
  468. }
  469. if (ACPI_SUCCESS(status)) {
  470. *return_value = value1;
  471. }
  472. return_ACPI_STATUS(status);
  473. }
  474. /******************************************************************************
  475. *
  476. * FUNCTION: acpi_hw_register_write
  477. *
  478. * PARAMETERS: use_lock - Mutex hw access
  479. * register_id - register_iD + Offset
  480. * Value - The value to write
  481. *
  482. * RETURN: Status
  483. *
  484. * DESCRIPTION: Acpi register Write function. Registers are written at the
  485. * given offset.
  486. *
  487. ******************************************************************************/
  488. acpi_status acpi_hw_register_write(u8 use_lock, u32 register_id, u32 value)
  489. {
  490. acpi_status status;
  491. ACPI_FUNCTION_TRACE("hw_register_write");
  492. if (ACPI_MTX_LOCK == use_lock) {
  493. status = acpi_ut_acquire_mutex(ACPI_MTX_HARDWARE);
  494. if (ACPI_FAILURE(status)) {
  495. return_ACPI_STATUS(status);
  496. }
  497. }
  498. switch (register_id) {
  499. case ACPI_REGISTER_PM1_STATUS: /* 16-bit access */
  500. status =
  501. acpi_hw_low_level_write(16, value,
  502. &acpi_gbl_FADT->xpm1a_evt_blk);
  503. if (ACPI_FAILURE(status)) {
  504. goto unlock_and_exit;
  505. }
  506. /* PM1B is optional */
  507. status =
  508. acpi_hw_low_level_write(16, value,
  509. &acpi_gbl_FADT->xpm1b_evt_blk);
  510. break;
  511. case ACPI_REGISTER_PM1_ENABLE: /* 16-bit access */
  512. status =
  513. acpi_hw_low_level_write(16, value, &acpi_gbl_xpm1a_enable);
  514. if (ACPI_FAILURE(status)) {
  515. goto unlock_and_exit;
  516. }
  517. /* PM1B is optional */
  518. status =
  519. acpi_hw_low_level_write(16, value, &acpi_gbl_xpm1b_enable);
  520. break;
  521. case ACPI_REGISTER_PM1_CONTROL: /* 16-bit access */
  522. status =
  523. acpi_hw_low_level_write(16, value,
  524. &acpi_gbl_FADT->xpm1a_cnt_blk);
  525. if (ACPI_FAILURE(status)) {
  526. goto unlock_and_exit;
  527. }
  528. status =
  529. acpi_hw_low_level_write(16, value,
  530. &acpi_gbl_FADT->xpm1b_cnt_blk);
  531. break;
  532. case ACPI_REGISTER_PM1A_CONTROL: /* 16-bit access */
  533. status =
  534. acpi_hw_low_level_write(16, value,
  535. &acpi_gbl_FADT->xpm1a_cnt_blk);
  536. break;
  537. case ACPI_REGISTER_PM1B_CONTROL: /* 16-bit access */
  538. status =
  539. acpi_hw_low_level_write(16, value,
  540. &acpi_gbl_FADT->xpm1b_cnt_blk);
  541. break;
  542. case ACPI_REGISTER_PM2_CONTROL: /* 8-bit access */
  543. status =
  544. acpi_hw_low_level_write(8, value,
  545. &acpi_gbl_FADT->xpm2_cnt_blk);
  546. break;
  547. case ACPI_REGISTER_PM_TIMER: /* 32-bit access */
  548. status =
  549. acpi_hw_low_level_write(32, value,
  550. &acpi_gbl_FADT->xpm_tmr_blk);
  551. break;
  552. case ACPI_REGISTER_SMI_COMMAND_BLOCK: /* 8-bit access */
  553. /* SMI_CMD is currently always in IO space */
  554. status = acpi_os_write_port(acpi_gbl_FADT->smi_cmd, value, 8);
  555. break;
  556. default:
  557. status = AE_BAD_PARAMETER;
  558. break;
  559. }
  560. unlock_and_exit:
  561. if (ACPI_MTX_LOCK == use_lock) {
  562. (void)acpi_ut_release_mutex(ACPI_MTX_HARDWARE);
  563. }
  564. return_ACPI_STATUS(status);
  565. }
  566. /******************************************************************************
  567. *
  568. * FUNCTION: acpi_hw_low_level_read
  569. *
  570. * PARAMETERS: Width - 8, 16, or 32
  571. * Value - Where the value is returned
  572. * Reg - GAS register structure
  573. *
  574. * RETURN: Status
  575. *
  576. * DESCRIPTION: Read from either memory or IO space.
  577. *
  578. ******************************************************************************/
  579. acpi_status
  580. acpi_hw_low_level_read(u32 width, u32 * value, struct acpi_generic_address *reg)
  581. {
  582. u64 address;
  583. acpi_status status;
  584. ACPI_FUNCTION_NAME("hw_low_level_read");
  585. /*
  586. * Must have a valid pointer to a GAS structure, and
  587. * a non-zero address within. However, don't return an error
  588. * because the PM1A/B code must not fail if B isn't present.
  589. */
  590. if (!reg) {
  591. return (AE_OK);
  592. }
  593. /* Get a local copy of the address. Handles possible alignment issues */
  594. ACPI_MOVE_64_TO_64(&address, &reg->address);
  595. if (!address) {
  596. return (AE_OK);
  597. }
  598. *value = 0;
  599. /*
  600. * Two address spaces supported: Memory or IO.
  601. * PCI_Config is not supported here because the GAS struct is insufficient
  602. */
  603. switch (reg->address_space_id) {
  604. case ACPI_ADR_SPACE_SYSTEM_MEMORY:
  605. status = acpi_os_read_memory((acpi_physical_address) address,
  606. value, width);
  607. break;
  608. case ACPI_ADR_SPACE_SYSTEM_IO:
  609. status = acpi_os_read_port((acpi_io_address) address,
  610. value, width);
  611. break;
  612. default:
  613. ACPI_REPORT_ERROR(("Unsupported address space: %X\n",
  614. reg->address_space_id));
  615. return (AE_BAD_PARAMETER);
  616. }
  617. ACPI_DEBUG_PRINT((ACPI_DB_IO,
  618. "Read: %8.8X width %2d from %8.8X%8.8X (%s)\n",
  619. *value, width,
  620. ACPI_FORMAT_UINT64(address),
  621. acpi_ut_get_region_name(reg->address_space_id)));
  622. return (status);
  623. }
  624. /******************************************************************************
  625. *
  626. * FUNCTION: acpi_hw_low_level_write
  627. *
  628. * PARAMETERS: Width - 8, 16, or 32
  629. * Value - To be written
  630. * Reg - GAS register structure
  631. *
  632. * RETURN: Status
  633. *
  634. * DESCRIPTION: Write to either memory or IO space.
  635. *
  636. ******************************************************************************/
  637. acpi_status
  638. acpi_hw_low_level_write(u32 width, u32 value, struct acpi_generic_address * reg)
  639. {
  640. u64 address;
  641. acpi_status status;
  642. ACPI_FUNCTION_NAME("hw_low_level_write");
  643. /*
  644. * Must have a valid pointer to a GAS structure, and
  645. * a non-zero address within. However, don't return an error
  646. * because the PM1A/B code must not fail if B isn't present.
  647. */
  648. if (!reg) {
  649. return (AE_OK);
  650. }
  651. /* Get a local copy of the address. Handles possible alignment issues */
  652. ACPI_MOVE_64_TO_64(&address, &reg->address);
  653. if (!address) {
  654. return (AE_OK);
  655. }
  656. /*
  657. * Two address spaces supported: Memory or IO.
  658. * PCI_Config is not supported here because the GAS struct is insufficient
  659. */
  660. switch (reg->address_space_id) {
  661. case ACPI_ADR_SPACE_SYSTEM_MEMORY:
  662. status = acpi_os_write_memory((acpi_physical_address) address,
  663. value, width);
  664. break;
  665. case ACPI_ADR_SPACE_SYSTEM_IO:
  666. status = acpi_os_write_port((acpi_io_address) address,
  667. value, width);
  668. break;
  669. default:
  670. ACPI_REPORT_ERROR(("Unsupported address space: %X\n",
  671. reg->address_space_id));
  672. return (AE_BAD_PARAMETER);
  673. }
  674. ACPI_DEBUG_PRINT((ACPI_DB_IO,
  675. "Wrote: %8.8X width %2d to %8.8X%8.8X (%s)\n",
  676. value, width,
  677. ACPI_FORMAT_UINT64(address),
  678. acpi_ut_get_region_name(reg->address_space_id)));
  679. return (status);
  680. }