blob: a4696805a1f2038009479849b537f981dd0d5006 [file] [log] [blame]
Shaunak Saha9dffbdd2017-03-08 19:27:17 -08001/*
2 * This file is part of the coreboot project.
3 *
4 * Copyright (C) 2017 Intel Corporation.
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; version 2 of the License.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 */
15
Shaunak Sahaf0738722017-10-02 15:01:33 -070016#include <arch/early_variables.h>
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080017#include <arch/io.h>
18#include <cbmem.h>
19#include <console/console.h>
20#include <halt.h>
21#include <intelblocks/pmclib.h>
22#include <intelblocks/gpio.h>
Subrata Banik7bc4dc52018-05-17 18:40:32 +053023#include <intelblocks/tco.h>
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080024#include <soc/pm.h>
Shaunak Sahaf0738722017-10-02 15:01:33 -070025#include <string.h>
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080026#include <timer.h>
Philipp Deppenwiesefea24292017-10-17 17:02:29 +020027#include <security/vboot/vboot_common.h>
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080028
Shaunak Sahaf0738722017-10-02 15:01:33 -070029static struct chipset_power_state power_state CAR_GLOBAL;
30
31struct chipset_power_state *pmc_get_power_state(void)
32{
33 struct chipset_power_state *ptr = NULL;
34
35 if (cbmem_possibly_online())
36 ptr = cbmem_find(CBMEM_ID_POWER_STATE);
37
38 /* cbmem is online but ptr is not populated yet */
39 if (ptr == NULL && !(ENV_RAMSTAGE || ENV_POSTCAR))
40 return car_get_var_ptr(&power_state);
41
42 return ptr;
43}
44
45static void migrate_power_state(int is_recovery)
46{
47 struct chipset_power_state *ps_cbmem;
48 struct chipset_power_state *ps_car;
49
50 ps_car = car_get_var_ptr(&power_state);
51 ps_cbmem = cbmem_add(CBMEM_ID_POWER_STATE, sizeof(*ps_cbmem));
52
53 if (ps_cbmem == NULL) {
54 printk(BIOS_DEBUG, "Not adding power state to cbmem!\n");
55 return;
56 }
57 memcpy(ps_cbmem, ps_car, sizeof(*ps_cbmem));
58}
59ROMSTAGE_CBMEM_INIT_HOOK(migrate_power_state)
60
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080061static void print_num_status_bits(int num_bits, uint32_t status,
62 const char *const bit_names[])
63{
64 int i;
65
66 if (!status)
67 return;
68
69 for (i = num_bits - 1; i >= 0; i--) {
70 if (status & (1 << i)) {
71 if (bit_names[i])
72 printk(BIOS_DEBUG, "%s ", bit_names[i]);
73 else
74 printk(BIOS_DEBUG, "BIT%d ", i);
75 }
76 }
77}
78
Aaron Durbin64031672018-04-21 14:45:32 -060079__weak uint32_t soc_get_smi_status(uint32_t generic_sts)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080080{
81 return generic_sts;
82}
83
Subrata Banik9b98feb2017-12-13 11:02:43 +053084/*
85 * Set PMC register to know which state system should be after
86 * power reapplied
87 */
Aaron Durbin64031672018-04-21 14:45:32 -060088__weak void pmc_soc_restore_power_failure(void)
Subrata Banik9b98feb2017-12-13 11:02:43 +053089{
90 /*
91 * SoC code should set PMC config register in order to set
92 * MAINBOARD_POWER_ON bit as per EDS.
93 */
94}
95
Bora Guvendik3cb0e272018-09-28 16:19:00 -070096int acpi_get_sleep_type(void)
97{
98 struct chipset_power_state *ps;
John Zhao0ccfc0c2018-10-16 10:48:00 -070099 int prev_sleep_state = ACPI_S0;
Bora Guvendik3cb0e272018-09-28 16:19:00 -0700100
101 ps = pmc_get_power_state();
John Zhao0ccfc0c2018-10-16 10:48:00 -0700102 if (ps)
103 prev_sleep_state = ps->prev_sleep_state;
104
105 return prev_sleep_state;
Bora Guvendik3cb0e272018-09-28 16:19:00 -0700106}
107
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800108static uint32_t pmc_reset_smi_status(void)
109{
110 uint32_t smi_sts = inl(ACPI_BASE_ADDRESS + SMI_STS);
111 outl(smi_sts, ACPI_BASE_ADDRESS + SMI_STS);
112
113 return soc_get_smi_status(smi_sts);
114}
115
116static uint32_t print_smi_status(uint32_t smi_sts)
117{
118 size_t array_size;
119 const char *const *smi_arr;
120
121 if (!smi_sts)
122 return 0;
123
124 printk(BIOS_DEBUG, "SMI_STS: ");
125
126 smi_arr = soc_smi_sts_array(&array_size);
127
128 print_num_status_bits(array_size, smi_sts, smi_arr);
129 printk(BIOS_DEBUG, "\n");
130
131 return smi_sts;
132}
133
Shaunak Saha25cc76f2017-09-28 15:13:05 -0700134/*
135 * Update supplied events in PM1_EN register. This does not disable any already
136 * set events.
137 */
138void pmc_update_pm1_enable(u16 events)
139{
140 u16 pm1_en = pmc_read_pm1_enable();
141 pm1_en |= events;
142 pmc_enable_pm1(pm1_en);
143}
144
145/* Read events set in PM1_EN register. */
146uint16_t pmc_read_pm1_enable(void)
147{
148 return inw(ACPI_BASE_ADDRESS + PM1_EN);
149}
150
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800151uint32_t pmc_clear_smi_status(void)
152{
153 uint32_t sts = pmc_reset_smi_status();
154
155 return print_smi_status(sts);
156}
157
158uint32_t pmc_get_smi_en(void)
159{
160 return inl(ACPI_BASE_ADDRESS + SMI_EN);
161}
162
163void pmc_enable_smi(uint32_t mask)
164{
165 uint32_t smi_en = inl(ACPI_BASE_ADDRESS + SMI_EN);
166 smi_en |= mask;
167 outl(smi_en, ACPI_BASE_ADDRESS + SMI_EN);
168}
169
170void pmc_disable_smi(uint32_t mask)
171{
172 uint32_t smi_en = inl(ACPI_BASE_ADDRESS + SMI_EN);
173 smi_en &= ~mask;
174 outl(smi_en, ACPI_BASE_ADDRESS + SMI_EN);
175}
176
177/* PM1 */
178void pmc_enable_pm1(uint16_t events)
179{
180 outw(events, ACPI_BASE_ADDRESS + PM1_EN);
181}
182
Furquan Shaikhab620182017-10-16 22:19:13 -0700183uint32_t pmc_read_pm1_control(void)
184{
185 return inl(ACPI_BASE_ADDRESS + PM1_CNT);
186}
187
188void pmc_write_pm1_control(uint32_t pm1_cnt)
189{
190 outl(pm1_cnt, ACPI_BASE_ADDRESS + PM1_CNT);
191}
192
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800193void pmc_enable_pm1_control(uint32_t mask)
194{
Furquan Shaikhab620182017-10-16 22:19:13 -0700195 uint32_t pm1_cnt = pmc_read_pm1_control();
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800196 pm1_cnt |= mask;
Furquan Shaikhab620182017-10-16 22:19:13 -0700197 pmc_write_pm1_control(pm1_cnt);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800198}
199
200void pmc_disable_pm1_control(uint32_t mask)
201{
Furquan Shaikhab620182017-10-16 22:19:13 -0700202 uint32_t pm1_cnt = pmc_read_pm1_control();
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800203 pm1_cnt &= ~mask;
Furquan Shaikhab620182017-10-16 22:19:13 -0700204 pmc_write_pm1_control(pm1_cnt);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800205}
206
207static uint16_t reset_pm1_status(void)
208{
209 uint16_t pm1_sts = inw(ACPI_BASE_ADDRESS + PM1_STS);
210 outw(pm1_sts, ACPI_BASE_ADDRESS + PM1_STS);
211 return pm1_sts;
212}
213
214static uint16_t print_pm1_status(uint16_t pm1_sts)
215{
216 static const char *const pm1_sts_bits[] = {
217 [0] = "TMROF",
218 [5] = "GBL",
219 [8] = "PWRBTN",
220 [10] = "RTC",
221 [11] = "PRBTNOR",
222 [13] = "USB",
223 [14] = "PCIEXPWAK",
224 [15] = "WAK",
225 };
226
227 if (!pm1_sts)
228 return 0;
229
230 printk(BIOS_SPEW, "PM1_STS: ");
231 print_num_status_bits(ARRAY_SIZE(pm1_sts_bits), pm1_sts, pm1_sts_bits);
232 printk(BIOS_SPEW, "\n");
233
234 return pm1_sts;
235}
236
237uint16_t pmc_clear_pm1_status(void)
238{
239 return print_pm1_status(reset_pm1_status());
240}
241
242/* TCO */
243
244static uint32_t print_tco_status(uint32_t tco_sts)
245{
246 size_t array_size;
247 const char *const *tco_arr;
248
249 if (!tco_sts)
250 return 0;
251
252 printk(BIOS_DEBUG, "TCO_STS: ");
253
254 tco_arr = soc_tco_sts_array(&array_size);
255
256 print_num_status_bits(array_size, tco_sts, tco_arr);
257 printk(BIOS_DEBUG, "\n");
258
259 return tco_sts;
260}
261
262uint32_t pmc_clear_tco_status(void)
263{
Subrata Banik7bc4dc52018-05-17 18:40:32 +0530264 return print_tco_status(tco_reset_status());
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800265}
266
267/* GPE */
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700268static void pmc_enable_gpe(int gpe, uint32_t mask)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800269{
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700270 uint32_t gpe0_en = inl(ACPI_BASE_ADDRESS + GPE0_EN(gpe));
271 gpe0_en |= mask;
272 outl(gpe0_en, ACPI_BASE_ADDRESS + GPE0_EN(gpe));
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800273}
274
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700275static void pmc_disable_gpe(int gpe, uint32_t mask)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800276{
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700277 uint32_t gpe0_en = inl(ACPI_BASE_ADDRESS + GPE0_EN(gpe));
278 gpe0_en &= ~mask;
279 outl(gpe0_en, ACPI_BASE_ADDRESS + GPE0_EN(gpe));
280}
281
282void pmc_enable_std_gpe(uint32_t mask)
283{
284 pmc_enable_gpe(GPE_STD, mask);
285}
286
287void pmc_disable_std_gpe(uint32_t mask)
288{
289 pmc_disable_gpe(GPE_STD, mask);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800290}
291
292void pmc_disable_all_gpe(void)
293{
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700294 int i;
295 for (i = 0; i < GPE0_REG_MAX; i++)
296 pmc_disable_gpe(i, ~0);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800297}
298
299/* Clear the gpio gpe0 status bits in ACPI registers */
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700300static void pmc_clear_gpi_gpe_status(void)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800301{
302 int i;
303
304 for (i = 0; i < GPE0_REG_MAX; i++) {
305 /* This is reserved GPE block and specific to chipset */
306 if (i == GPE_STD)
307 continue;
308 uint32_t gpe_sts = inl(ACPI_BASE_ADDRESS + GPE0_STS(i));
309 outl(gpe_sts, ACPI_BASE_ADDRESS + GPE0_STS(i));
310 }
311}
312
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700313static uint32_t reset_std_gpe_status(void)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800314{
315 uint32_t gpe_sts = inl(ACPI_BASE_ADDRESS + GPE0_STS(GPE_STD));
316 outl(gpe_sts, ACPI_BASE_ADDRESS + GPE0_STS(GPE_STD));
317 return gpe_sts;
318}
319
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700320static uint32_t print_std_gpe_sts(uint32_t gpe_sts)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800321{
322 size_t array_size;
323 const char *const *sts_arr;
324
325 if (!gpe_sts)
326 return gpe_sts;
327
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700328 printk(BIOS_DEBUG, "GPE0 STD STS: ");
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800329
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700330 sts_arr = soc_std_gpe_sts_array(&array_size);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800331 print_num_status_bits(array_size, gpe_sts, sts_arr);
332 printk(BIOS_DEBUG, "\n");
333
334 return gpe_sts;
335}
336
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700337static void pmc_clear_std_gpe_status(void)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800338{
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700339 print_std_gpe_sts(reset_std_gpe_status());
340}
341
342void pmc_clear_all_gpe_status(void)
343{
344 pmc_clear_std_gpe_status();
345 pmc_clear_gpi_gpe_status();
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800346}
347
Aaron Durbin64031672018-04-21 14:45:32 -0600348__weak
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800349void soc_clear_pm_registers(uintptr_t pmc_bar)
350{
351}
352
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700353void pmc_clear_prsts(void)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800354{
355 uint32_t prsts;
356 uintptr_t pmc_bar;
357
358 /* Read PMC base address from soc */
359 pmc_bar = soc_read_pmc_base();
360
361 prsts = read32((void *)(pmc_bar + PRSTS));
362 write32((void *)(pmc_bar + PRSTS), prsts);
363
364 soc_clear_pm_registers(pmc_bar);
365}
366
Aaron Durbin64031672018-04-21 14:45:32 -0600367__weak
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800368int soc_prev_sleep_state(const struct chipset_power_state *ps,
369 int prev_sleep_state)
370{
371 return prev_sleep_state;
372}
373
374/*
375 * Returns prev_sleep_state and also prints all power management registers.
Jonathan Neuschäfer5268b762018-02-12 12:24:25 +0100376 * Calls soc_prev_sleep_state which may be implemented by SOC.
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800377 */
378static int pmc_prev_sleep_state(const struct chipset_power_state *ps)
379{
380 /* Default to S0. */
381 int prev_sleep_state = ACPI_S0;
382
383 if (ps->pm1_sts & WAK_STS) {
384 switch (acpi_sleep_from_pm1(ps->pm1_cnt)) {
385 case ACPI_S3:
386 if (IS_ENABLED(CONFIG_HAVE_ACPI_RESUME))
387 prev_sleep_state = ACPI_S3;
388 break;
389 case ACPI_S5:
390 prev_sleep_state = ACPI_S5;
391 break;
392 }
393
394 /* Clear SLP_TYP. */
Furquan Shaikhab620182017-10-16 22:19:13 -0700395 pmc_write_pm1_control(ps->pm1_cnt & ~(SLP_TYP));
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800396 }
397 return soc_prev_sleep_state(ps, prev_sleep_state);
398}
399
Furquan Shaikhe48fb542017-10-17 16:00:10 -0700400void pmc_fill_pm_reg_info(struct chipset_power_state *ps)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800401{
402 int i;
403
Furquan Shaikhe48fb542017-10-17 16:00:10 -0700404 memset(ps, 0, sizeof(*ps));
405
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800406 ps->pm1_sts = inw(ACPI_BASE_ADDRESS + PM1_STS);
407 ps->pm1_en = inw(ACPI_BASE_ADDRESS + PM1_EN);
Furquan Shaikhab620182017-10-16 22:19:13 -0700408 ps->pm1_cnt = pmc_read_pm1_control();
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800409
410 printk(BIOS_DEBUG, "pm1_sts: %04x pm1_en: %04x pm1_cnt: %08x\n",
411 ps->pm1_sts, ps->pm1_en, ps->pm1_cnt);
412
413 for (i = 0; i < GPE0_REG_MAX; i++) {
414 ps->gpe0_sts[i] = inl(ACPI_BASE_ADDRESS + GPE0_STS(i));
415 ps->gpe0_en[i] = inl(ACPI_BASE_ADDRESS + GPE0_EN(i));
416 printk(BIOS_DEBUG, "gpe0_sts[%d]: %08x gpe0_en[%d]: %08x\n",
417 i, ps->gpe0_sts[i], i, ps->gpe0_en[i]);
418 }
419
420 soc_fill_power_state(ps);
Furquan Shaikhe48fb542017-10-17 16:00:10 -0700421}
422
423/* Reads and prints ACPI specific PM registers */
424int pmc_fill_power_state(struct chipset_power_state *ps)
425{
426 pmc_fill_pm_reg_info(ps);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800427
428 ps->prev_sleep_state = pmc_prev_sleep_state(ps);
429 printk(BIOS_DEBUG, "prev_sleep_state %d\n", ps->prev_sleep_state);
430
431 return ps->prev_sleep_state;
432}
433
Julien Viard de Galbert2912e8e2018-08-14 16:15:26 +0200434#if IS_ENABLED(CONFIG_PMC_GLOBAL_RESET_ENABLE_LOCK)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800435/*
436 * If possible, lock 0xcf9. Once the register is locked, it can't be changed.
437 * This lock is reset on cold boot, hard reset, soft reset and Sx.
438 */
439void pmc_global_reset_lock(void)
440{
441 /* Read PMC base address from soc */
442 uintptr_t etr = soc_read_pmc_base() + ETR;
443 uint32_t reg;
444
445 reg = read32((void *)etr);
446 if (reg & CF9_LOCK)
447 return;
448 reg |= CF9_LOCK;
449 write32((void *)etr, reg);
450}
451
452/*
453 * Enable or disable global reset. If global reset is enabled, hard reset and
454 * soft reset will trigger global reset, where both host and TXE are reset.
455 * This is cleared on cold boot, hard reset, soft reset and Sx.
456 */
457void pmc_global_reset_enable(bool enable)
458{
459 /* Read PMC base address from soc */
460 uintptr_t etr = soc_read_pmc_base() + ETR;
461 uint32_t reg;
462
463 reg = read32((void *)etr);
464 reg = enable ? reg | CF9_GLB_RST : reg & ~CF9_GLB_RST;
465 write32((void *)etr, reg);
466}
Julien Viard de Galbert2912e8e2018-08-14 16:15:26 +0200467#endif // CONFIG_PMC_GLOBAL_RESET_ENABLE_LOCK
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800468
469int vboot_platform_is_resuming(void)
470{
471 if (!(inw(ACPI_BASE_ADDRESS + PM1_STS) & WAK_STS))
472 return 0;
473
Furquan Shaikhab620182017-10-16 22:19:13 -0700474 return acpi_sleep_from_pm1(pmc_read_pm1_control()) == ACPI_S3;
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800475}
476
477/* Read and clear GPE status (defined in arch/acpi.h) */
478int acpi_get_gpe(int gpe)
479{
480 int bank;
481 uint32_t mask, sts;
482 struct stopwatch sw;
483 int rc = 0;
484
485 if (gpe < 0 || gpe > GPE_MAX)
486 return -1;
487
488 bank = gpe / 32;
489 mask = 1 << (gpe % 32);
490
491 /* Wait up to 1ms for GPE status to clear */
492 stopwatch_init_msecs_expire(&sw, 1);
493 do {
494 if (stopwatch_expired(&sw))
495 return rc;
496
497 sts = inl(ACPI_BASE_ADDRESS + GPE0_STS(bank));
498 if (sts & mask) {
499 outl(mask, ACPI_BASE_ADDRESS + GPE0_STS(bank));
500 rc = 1;
501 }
502 } while (sts & mask);
503
504 return rc;
505}
506
507/*
508 * The PM1 control is set to S5 when vboot requests a reboot because the power
509 * state code above may not have collected its data yet. Therefore, set it to
510 * S5 when vboot requests a reboot. That's necessary if vboot fails in the
511 * resume path and requests a reboot. This prevents a reboot loop where the
512 * error is continually hit on the failing vboot resume path.
513 */
514void vboot_platform_prepare_reboot(void)
515{
Furquan Shaikhab620182017-10-16 22:19:13 -0700516 uint32_t pm1_cnt;
517 pm1_cnt = (pmc_read_pm1_control() & ~(SLP_TYP)) |
518 (SLP_TYP_S5 << SLP_TYP_SHIFT);
519 pmc_write_pm1_control(pm1_cnt);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800520}
521
522void poweroff(void)
523{
524 pmc_enable_pm1_control(SLP_EN | (SLP_TYP_S5 << SLP_TYP_SHIFT));
525
526 /*
527 * Setting SLP_TYP_S5 in PM1 triggers SLP_SMI, which is handled by SMM
528 * to transition to S5 state. If halt is called in SMM, then it prevents
529 * the SMI handler from being triggered and system never enters S5.
530 */
531 if (!ENV_SMM)
532 halt();
533}
534
535void pmc_gpe_init(void)
536{
537 uint32_t gpio_cfg = 0;
538 uint32_t gpio_cfg_reg;
539 uint8_t dw0, dw1, dw2;
540
541 /* Read PMC base address from soc. This is implemented in soc */
542 uintptr_t pmc_bar = soc_read_pmc_base();
543
544 /*
545 * Get the dwX values for pmc gpe settings.
546 */
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700547 soc_get_gpi_gpe_configs(&dw0, &dw1, &dw2);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800548
549 const uint32_t gpio_cfg_mask =
550 (GPE0_DWX_MASK << GPE0_DW_SHIFT(0)) |
551 (GPE0_DWX_MASK << GPE0_DW_SHIFT(1)) |
552 (GPE0_DWX_MASK << GPE0_DW_SHIFT(2));
553
554 /* Making sure that bad values don't bleed into the other fields */
555 dw0 &= GPE0_DWX_MASK;
556 dw1 &= GPE0_DWX_MASK;
557 dw2 &= GPE0_DWX_MASK;
558
559 /*
560 * Route the GPIOs to the GPE0 block. Determine that all values
561 * are different, and if they aren't use the reset values.
562 */
563 if (dw0 == dw1 || dw1 == dw2) {
564 printk(BIOS_INFO, "PMC: Using default GPE route.\n");
565 gpio_cfg = read32((void *)pmc_bar + GPIO_GPE_CFG);
566
567 dw0 = (gpio_cfg >> GPE0_DW_SHIFT(0)) & GPE0_DWX_MASK;
568 dw1 = (gpio_cfg >> GPE0_DW_SHIFT(1)) & GPE0_DWX_MASK;
569 dw2 = (gpio_cfg >> GPE0_DW_SHIFT(2)) & GPE0_DWX_MASK;
570 } else {
571 gpio_cfg |= (uint32_t) dw0 << GPE0_DW_SHIFT(0);
572 gpio_cfg |= (uint32_t) dw1 << GPE0_DW_SHIFT(1);
573 gpio_cfg |= (uint32_t) dw2 << GPE0_DW_SHIFT(2);
574 }
575
576 gpio_cfg_reg = read32((void *)pmc_bar + GPIO_GPE_CFG) & ~gpio_cfg_mask;
577 gpio_cfg_reg |= gpio_cfg & gpio_cfg_mask;
578
579 write32((void *)pmc_bar + GPIO_GPE_CFG, gpio_cfg_reg);
580
581 /* Set the routes in the GPIO communities as well. */
582 gpio_route_gpe(dw0, dw1, dw2);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800583}