Angel Pons | f94ac9a | 2020-04-05 15:46:48 +0200 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 2 | |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 3 | #include <arch/io.h> |
Kyösti Mälkki | f1b58b7 | 2019-03-01 13:43:02 +0200 | [diff] [blame] | 4 | #include <device/pci_ops.h> |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 5 | #include <cbmem.h> |
| 6 | #include <console/console.h> |
| 7 | #include <device/device.h> |
| 8 | #include <device/pci.h> |
| 9 | #include <device/pci_def.h> |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 10 | #include <string.h> |
Julius Werner | 4ee4bd5 | 2014-10-20 13:46:39 -0700 | [diff] [blame] | 11 | #include <soc/iomap.h> |
| 12 | #include <soc/lpc.h> |
| 13 | #include <soc/pci_devs.h> |
| 14 | #include <soc/pm.h> |
| 15 | #include <soc/romstage.h> |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 16 | |
Arthur Heymans | 7ea4e02 | 2018-12-29 14:20:00 +0100 | [diff] [blame] | 17 | static struct chipset_power_state power_state; |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 18 | |
Aaron Durbin | 41607a4 | 2015-06-09 13:54:10 -0500 | [diff] [blame] | 19 | static void migrate_power_state(int is_recovery) |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 20 | { |
| 21 | struct chipset_power_state *ps_cbmem; |
| 22 | struct chipset_power_state *ps_car; |
| 23 | |
Arthur Heymans | 7ea4e02 | 2018-12-29 14:20:00 +0100 | [diff] [blame] | 24 | ps_car = &power_state; |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 25 | ps_cbmem = cbmem_add(CBMEM_ID_POWER_STATE, sizeof(*ps_cbmem)); |
| 26 | |
| 27 | if (ps_cbmem == NULL) { |
| 28 | printk(BIOS_DEBUG, "Not adding power state to cbmem!\n"); |
| 29 | return; |
| 30 | } |
| 31 | memcpy(ps_cbmem, ps_car, sizeof(*ps_cbmem)); |
| 32 | } |
Kyösti Mälkki | fa3bc04 | 2022-03-31 07:40:10 +0300 | [diff] [blame^] | 33 | CBMEM_CREATION_HOOK(migrate_power_state); |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 34 | |
| 35 | /* Return 0, 3, or 5 to indicate the previous sleep state. */ |
Kyösti Mälkki | 540902c | 2021-01-22 08:02:50 +0200 | [diff] [blame] | 36 | static int prev_sleep_state(const struct chipset_power_state *ps) |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 37 | { |
| 38 | /* Default to S0. */ |
Aaron Durbin | 9e6d143 | 2016-07-13 23:21:41 -0500 | [diff] [blame] | 39 | int prev_sleep_state = ACPI_S0; |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 40 | |
| 41 | if (ps->pm1_sts & WAK_STS) { |
Aaron Durbin | 9e6d143 | 2016-07-13 23:21:41 -0500 | [diff] [blame] | 42 | switch (acpi_sleep_from_pm1(ps->pm1_cnt)) { |
| 43 | case ACPI_S3: |
Julius Werner | cd49cce | 2019-03-05 16:53:33 -0800 | [diff] [blame] | 44 | if (CONFIG(HAVE_ACPI_RESUME)) |
Aaron Durbin | 9e6d143 | 2016-07-13 23:21:41 -0500 | [diff] [blame] | 45 | prev_sleep_state = ACPI_S3; |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 46 | break; |
Aaron Durbin | 9e6d143 | 2016-07-13 23:21:41 -0500 | [diff] [blame] | 47 | case ACPI_S5: |
| 48 | prev_sleep_state = ACPI_S5; |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 49 | break; |
| 50 | } |
| 51 | /* Clear SLP_TYP. */ |
| 52 | outl(ps->pm1_cnt & ~(SLP_TYP), ACPI_BASE_ADDRESS + PM1_CNT); |
| 53 | } |
| 54 | |
| 55 | if (ps->gen_pmcon3 & (PWR_FLR | SUS_PWR_FLR)) |
Aaron Durbin | 9e6d143 | 2016-07-13 23:21:41 -0500 | [diff] [blame] | 56 | prev_sleep_state = ACPI_S5; |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 57 | |
| 58 | return prev_sleep_state; |
| 59 | } |
| 60 | |
| 61 | static void dump_power_state(struct chipset_power_state *ps) |
| 62 | { |
| 63 | printk(BIOS_DEBUG, "PM1_STS: %04x\n", ps->pm1_sts); |
| 64 | printk(BIOS_DEBUG, "PM1_EN: %04x\n", ps->pm1_en); |
| 65 | printk(BIOS_DEBUG, "PM1_CNT: %08x\n", ps->pm1_cnt); |
Duncan Laurie | 047f03a | 2014-08-11 09:54:19 -0700 | [diff] [blame] | 66 | printk(BIOS_DEBUG, "TCO_STS: %04x %04x\n", |
| 67 | ps->tco1_sts, ps->tco2_sts); |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 68 | |
| 69 | printk(BIOS_DEBUG, "GPE0_STS: %08x %08x %08x %08x\n", |
| 70 | ps->gpe0_sts[0], ps->gpe0_sts[1], |
| 71 | ps->gpe0_sts[2], ps->gpe0_sts[3]); |
| 72 | printk(BIOS_DEBUG, "GPE0_EN: %08x %08x %08x %08x\n", |
| 73 | ps->gpe0_en[0], ps->gpe0_en[1], |
| 74 | ps->gpe0_en[2], ps->gpe0_en[3]); |
| 75 | |
| 76 | printk(BIOS_DEBUG, "GEN_PMCON: %04x %04x %04x\n", |
| 77 | ps->gen_pmcon1, ps->gen_pmcon2, ps->gen_pmcon3); |
| 78 | |
| 79 | printk(BIOS_DEBUG, "Previous Sleep State: S%d\n", |
| 80 | ps->prev_sleep_state); |
| 81 | } |
| 82 | |
| 83 | /* Fill power state structure from ACPI PM registers */ |
| 84 | struct chipset_power_state *fill_power_state(void) |
| 85 | { |
Arthur Heymans | 7ea4e02 | 2018-12-29 14:20:00 +0100 | [diff] [blame] | 86 | struct chipset_power_state *ps = &power_state; |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 87 | |
| 88 | ps->pm1_sts = inw(ACPI_BASE_ADDRESS + PM1_STS); |
| 89 | ps->pm1_en = inw(ACPI_BASE_ADDRESS + PM1_EN); |
| 90 | ps->pm1_cnt = inl(ACPI_BASE_ADDRESS + PM1_CNT); |
Duncan Laurie | 047f03a | 2014-08-11 09:54:19 -0700 | [diff] [blame] | 91 | ps->tco1_sts = inw(ACPI_BASE_ADDRESS + TCO1_STS); |
| 92 | ps->tco2_sts = inw(ACPI_BASE_ADDRESS + TCO2_STS); |
Duncan Laurie | c88c54c | 2014-04-30 16:36:13 -0700 | [diff] [blame] | 93 | ps->gpe0_sts[0] = inl(ACPI_BASE_ADDRESS + GPE0_STS(0)); |
| 94 | ps->gpe0_sts[1] = inl(ACPI_BASE_ADDRESS + GPE0_STS(1)); |
| 95 | ps->gpe0_sts[2] = inl(ACPI_BASE_ADDRESS + GPE0_STS(2)); |
| 96 | ps->gpe0_sts[3] = inl(ACPI_BASE_ADDRESS + GPE0_STS(3)); |
| 97 | ps->gpe0_en[0] = inl(ACPI_BASE_ADDRESS + GPE0_EN(0)); |
| 98 | ps->gpe0_en[1] = inl(ACPI_BASE_ADDRESS + GPE0_EN(1)); |
| 99 | ps->gpe0_en[2] = inl(ACPI_BASE_ADDRESS + GPE0_EN(2)); |
| 100 | ps->gpe0_en[3] = inl(ACPI_BASE_ADDRESS + GPE0_EN(3)); |
| 101 | |
| 102 | ps->gen_pmcon1 = pci_read_config16(PCH_DEV_LPC, GEN_PMCON_1); |
| 103 | ps->gen_pmcon2 = pci_read_config16(PCH_DEV_LPC, GEN_PMCON_2); |
| 104 | ps->gen_pmcon3 = pci_read_config16(PCH_DEV_LPC, GEN_PMCON_3); |
| 105 | |
| 106 | ps->prev_sleep_state = prev_sleep_state(ps); |
| 107 | |
| 108 | dump_power_state(ps); |
| 109 | |
| 110 | return ps; |
| 111 | } |