hwregs.c 24 KB

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