blob: f58d36246e083f55c06e1e75fe638c8865e082ba [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>
Kyösti Mälkki13f66502019-03-03 08:01:05 +020018#include <device/mmio.h>
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080019#include <cbmem.h>
20#include <console/console.h>
21#include <halt.h>
22#include <intelblocks/pmclib.h>
23#include <intelblocks/gpio.h>
Subrata Banik7bc4dc52018-05-17 18:40:32 +053024#include <intelblocks/tco.h>
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080025#include <soc/pm.h>
Shaunak Sahaf0738722017-10-02 15:01:33 -070026#include <string.h>
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080027#include <timer.h>
Philipp Deppenwiesefea24292017-10-17 17:02:29 +020028#include <security/vboot/vboot_common.h>
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080029
Shaunak Sahaf0738722017-10-02 15:01:33 -070030static struct chipset_power_state power_state CAR_GLOBAL;
31
32struct chipset_power_state *pmc_get_power_state(void)
33{
34 struct chipset_power_state *ptr = NULL;
35
36 if (cbmem_possibly_online())
37 ptr = cbmem_find(CBMEM_ID_POWER_STATE);
38
39 /* cbmem is online but ptr is not populated yet */
40 if (ptr == NULL && !(ENV_RAMSTAGE || ENV_POSTCAR))
41 return car_get_var_ptr(&power_state);
42
43 return ptr;
44}
45
46static void migrate_power_state(int is_recovery)
47{
48 struct chipset_power_state *ps_cbmem;
49 struct chipset_power_state *ps_car;
50
51 ps_car = car_get_var_ptr(&power_state);
52 ps_cbmem = cbmem_add(CBMEM_ID_POWER_STATE, sizeof(*ps_cbmem));
53
54 if (ps_cbmem == NULL) {
55 printk(BIOS_DEBUG, "Not adding power state to cbmem!\n");
56 return;
57 }
58 memcpy(ps_cbmem, ps_car, sizeof(*ps_cbmem));
59}
60ROMSTAGE_CBMEM_INIT_HOOK(migrate_power_state)
61
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080062static void print_num_status_bits(int num_bits, uint32_t status,
63 const char *const bit_names[])
64{
65 int i;
66
67 if (!status)
68 return;
69
70 for (i = num_bits - 1; i >= 0; i--) {
71 if (status & (1 << i)) {
72 if (bit_names[i])
73 printk(BIOS_DEBUG, "%s ", bit_names[i]);
74 else
75 printk(BIOS_DEBUG, "BIT%d ", i);
76 }
77 }
78}
79
Aaron Durbin64031672018-04-21 14:45:32 -060080__weak uint32_t soc_get_smi_status(uint32_t generic_sts)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080081{
82 return generic_sts;
83}
84
Subrata Banik9b98feb2017-12-13 11:02:43 +053085/*
86 * Set PMC register to know which state system should be after
87 * power reapplied
88 */
Aaron Durbin64031672018-04-21 14:45:32 -060089__weak void pmc_soc_restore_power_failure(void)
Subrata Banik9b98feb2017-12-13 11:02:43 +053090{
91 /*
92 * SoC code should set PMC config register in order to set
93 * MAINBOARD_POWER_ON bit as per EDS.
94 */
95}
96
Bora Guvendik3cb0e272018-09-28 16:19:00 -070097int acpi_get_sleep_type(void)
98{
99 struct chipset_power_state *ps;
John Zhao0ccfc0c2018-10-16 10:48:00 -0700100 int prev_sleep_state = ACPI_S0;
Bora Guvendik3cb0e272018-09-28 16:19:00 -0700101
102 ps = pmc_get_power_state();
John Zhao0ccfc0c2018-10-16 10:48:00 -0700103 if (ps)
104 prev_sleep_state = ps->prev_sleep_state;
105
106 return prev_sleep_state;
Bora Guvendik3cb0e272018-09-28 16:19:00 -0700107}
108
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800109static uint32_t pmc_reset_smi_status(void)
110{
111 uint32_t smi_sts = inl(ACPI_BASE_ADDRESS + SMI_STS);
112 outl(smi_sts, ACPI_BASE_ADDRESS + SMI_STS);
113
114 return soc_get_smi_status(smi_sts);
115}
116
117static uint32_t print_smi_status(uint32_t smi_sts)
118{
119 size_t array_size;
120 const char *const *smi_arr;
121
122 if (!smi_sts)
123 return 0;
124
125 printk(BIOS_DEBUG, "SMI_STS: ");
126
127 smi_arr = soc_smi_sts_array(&array_size);
128
129 print_num_status_bits(array_size, smi_sts, smi_arr);
130 printk(BIOS_DEBUG, "\n");
131
132 return smi_sts;
133}
134
Shaunak Saha25cc76f2017-09-28 15:13:05 -0700135/*
136 * Update supplied events in PM1_EN register. This does not disable any already
137 * set events.
138 */
139void pmc_update_pm1_enable(u16 events)
140{
141 u16 pm1_en = pmc_read_pm1_enable();
142 pm1_en |= events;
143 pmc_enable_pm1(pm1_en);
144}
145
146/* Read events set in PM1_EN register. */
147uint16_t pmc_read_pm1_enable(void)
148{
149 return inw(ACPI_BASE_ADDRESS + PM1_EN);
150}
151
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800152uint32_t pmc_clear_smi_status(void)
153{
154 uint32_t sts = pmc_reset_smi_status();
155
156 return print_smi_status(sts);
157}
158
159uint32_t pmc_get_smi_en(void)
160{
161 return inl(ACPI_BASE_ADDRESS + SMI_EN);
162}
163
164void pmc_enable_smi(uint32_t mask)
165{
166 uint32_t smi_en = inl(ACPI_BASE_ADDRESS + SMI_EN);
167 smi_en |= mask;
168 outl(smi_en, ACPI_BASE_ADDRESS + SMI_EN);
169}
170
171void pmc_disable_smi(uint32_t mask)
172{
173 uint32_t smi_en = inl(ACPI_BASE_ADDRESS + SMI_EN);
174 smi_en &= ~mask;
175 outl(smi_en, ACPI_BASE_ADDRESS + SMI_EN);
176}
177
178/* PM1 */
179void pmc_enable_pm1(uint16_t events)
180{
181 outw(events, ACPI_BASE_ADDRESS + PM1_EN);
182}
183
Furquan Shaikhab620182017-10-16 22:19:13 -0700184uint32_t pmc_read_pm1_control(void)
185{
186 return inl(ACPI_BASE_ADDRESS + PM1_CNT);
187}
188
189void pmc_write_pm1_control(uint32_t pm1_cnt)
190{
191 outl(pm1_cnt, ACPI_BASE_ADDRESS + PM1_CNT);
192}
193
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800194void pmc_enable_pm1_control(uint32_t mask)
195{
Furquan Shaikhab620182017-10-16 22:19:13 -0700196 uint32_t pm1_cnt = pmc_read_pm1_control();
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800197 pm1_cnt |= mask;
Furquan Shaikhab620182017-10-16 22:19:13 -0700198 pmc_write_pm1_control(pm1_cnt);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800199}
200
201void pmc_disable_pm1_control(uint32_t mask)
202{
Furquan Shaikhab620182017-10-16 22:19:13 -0700203 uint32_t pm1_cnt = pmc_read_pm1_control();
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800204 pm1_cnt &= ~mask;
Furquan Shaikhab620182017-10-16 22:19:13 -0700205 pmc_write_pm1_control(pm1_cnt);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800206}
207
208static uint16_t reset_pm1_status(void)
209{
210 uint16_t pm1_sts = inw(ACPI_BASE_ADDRESS + PM1_STS);
211 outw(pm1_sts, ACPI_BASE_ADDRESS + PM1_STS);
212 return pm1_sts;
213}
214
215static uint16_t print_pm1_status(uint16_t pm1_sts)
216{
217 static const char *const pm1_sts_bits[] = {
218 [0] = "TMROF",
219 [5] = "GBL",
220 [8] = "PWRBTN",
221 [10] = "RTC",
222 [11] = "PRBTNOR",
223 [13] = "USB",
224 [14] = "PCIEXPWAK",
225 [15] = "WAK",
226 };
227
228 if (!pm1_sts)
229 return 0;
230
231 printk(BIOS_SPEW, "PM1_STS: ");
232 print_num_status_bits(ARRAY_SIZE(pm1_sts_bits), pm1_sts, pm1_sts_bits);
233 printk(BIOS_SPEW, "\n");
234
235 return pm1_sts;
236}
237
238uint16_t pmc_clear_pm1_status(void)
239{
240 return print_pm1_status(reset_pm1_status());
241}
242
243/* TCO */
244
245static uint32_t print_tco_status(uint32_t tco_sts)
246{
247 size_t array_size;
248 const char *const *tco_arr;
249
250 if (!tco_sts)
251 return 0;
252
253 printk(BIOS_DEBUG, "TCO_STS: ");
254
255 tco_arr = soc_tco_sts_array(&array_size);
256
257 print_num_status_bits(array_size, tco_sts, tco_arr);
258 printk(BIOS_DEBUG, "\n");
259
260 return tco_sts;
261}
262
263uint32_t pmc_clear_tco_status(void)
264{
Subrata Banik7bc4dc52018-05-17 18:40:32 +0530265 return print_tco_status(tco_reset_status());
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800266}
267
268/* GPE */
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700269static void pmc_enable_gpe(int gpe, uint32_t mask)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800270{
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700271 uint32_t gpe0_en = inl(ACPI_BASE_ADDRESS + GPE0_EN(gpe));
272 gpe0_en |= mask;
273 outl(gpe0_en, ACPI_BASE_ADDRESS + GPE0_EN(gpe));
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800274}
275
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700276static void pmc_disable_gpe(int gpe, uint32_t mask)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800277{
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700278 uint32_t gpe0_en = inl(ACPI_BASE_ADDRESS + GPE0_EN(gpe));
279 gpe0_en &= ~mask;
280 outl(gpe0_en, ACPI_BASE_ADDRESS + GPE0_EN(gpe));
281}
282
283void pmc_enable_std_gpe(uint32_t mask)
284{
285 pmc_enable_gpe(GPE_STD, mask);
286}
287
288void pmc_disable_std_gpe(uint32_t mask)
289{
290 pmc_disable_gpe(GPE_STD, mask);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800291}
292
293void pmc_disable_all_gpe(void)
294{
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700295 int i;
296 for (i = 0; i < GPE0_REG_MAX; i++)
297 pmc_disable_gpe(i, ~0);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800298}
299
300/* Clear the gpio gpe0 status bits in ACPI registers */
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700301static void pmc_clear_gpi_gpe_status(void)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800302{
303 int i;
304
305 for (i = 0; i < GPE0_REG_MAX; i++) {
306 /* This is reserved GPE block and specific to chipset */
307 if (i == GPE_STD)
308 continue;
309 uint32_t gpe_sts = inl(ACPI_BASE_ADDRESS + GPE0_STS(i));
310 outl(gpe_sts, ACPI_BASE_ADDRESS + GPE0_STS(i));
311 }
312}
313
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700314static uint32_t reset_std_gpe_status(void)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800315{
316 uint32_t gpe_sts = inl(ACPI_BASE_ADDRESS + GPE0_STS(GPE_STD));
317 outl(gpe_sts, ACPI_BASE_ADDRESS + GPE0_STS(GPE_STD));
318 return gpe_sts;
319}
320
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700321static uint32_t print_std_gpe_sts(uint32_t gpe_sts)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800322{
323 size_t array_size;
324 const char *const *sts_arr;
325
326 if (!gpe_sts)
327 return gpe_sts;
328
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700329 printk(BIOS_DEBUG, "GPE0 STD STS: ");
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800330
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700331 sts_arr = soc_std_gpe_sts_array(&array_size);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800332 print_num_status_bits(array_size, gpe_sts, sts_arr);
333 printk(BIOS_DEBUG, "\n");
334
335 return gpe_sts;
336}
337
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700338static void pmc_clear_std_gpe_status(void)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800339{
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700340 print_std_gpe_sts(reset_std_gpe_status());
341}
342
343void pmc_clear_all_gpe_status(void)
344{
345 pmc_clear_std_gpe_status();
346 pmc_clear_gpi_gpe_status();
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800347}
348
Aaron Durbin64031672018-04-21 14:45:32 -0600349__weak
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800350void soc_clear_pm_registers(uintptr_t pmc_bar)
351{
352}
353
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700354void pmc_clear_prsts(void)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800355{
356 uint32_t prsts;
357 uintptr_t pmc_bar;
358
359 /* Read PMC base address from soc */
360 pmc_bar = soc_read_pmc_base();
361
362 prsts = read32((void *)(pmc_bar + PRSTS));
363 write32((void *)(pmc_bar + PRSTS), prsts);
364
365 soc_clear_pm_registers(pmc_bar);
366}
367
Aaron Durbin64031672018-04-21 14:45:32 -0600368__weak
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800369int soc_prev_sleep_state(const struct chipset_power_state *ps,
370 int prev_sleep_state)
371{
372 return prev_sleep_state;
373}
374
375/*
376 * Returns prev_sleep_state and also prints all power management registers.
Jonathan Neuschäfer5268b762018-02-12 12:24:25 +0100377 * Calls soc_prev_sleep_state which may be implemented by SOC.
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800378 */
379static int pmc_prev_sleep_state(const struct chipset_power_state *ps)
380{
381 /* Default to S0. */
382 int prev_sleep_state = ACPI_S0;
383
384 if (ps->pm1_sts & WAK_STS) {
385 switch (acpi_sleep_from_pm1(ps->pm1_cnt)) {
386 case ACPI_S3:
Julius Wernercd49cce2019-03-05 16:53:33 -0800387 if (CONFIG(HAVE_ACPI_RESUME))
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800388 prev_sleep_state = ACPI_S3;
389 break;
390 case ACPI_S5:
391 prev_sleep_state = ACPI_S5;
392 break;
393 }
394
395 /* Clear SLP_TYP. */
Furquan Shaikhab620182017-10-16 22:19:13 -0700396 pmc_write_pm1_control(ps->pm1_cnt & ~(SLP_TYP));
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800397 }
398 return soc_prev_sleep_state(ps, prev_sleep_state);
399}
400
Furquan Shaikhe48fb542017-10-17 16:00:10 -0700401void pmc_fill_pm_reg_info(struct chipset_power_state *ps)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800402{
403 int i;
404
Furquan Shaikhe48fb542017-10-17 16:00:10 -0700405 memset(ps, 0, sizeof(*ps));
406
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800407 ps->pm1_sts = inw(ACPI_BASE_ADDRESS + PM1_STS);
408 ps->pm1_en = inw(ACPI_BASE_ADDRESS + PM1_EN);
Furquan Shaikhab620182017-10-16 22:19:13 -0700409 ps->pm1_cnt = pmc_read_pm1_control();
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800410
411 printk(BIOS_DEBUG, "pm1_sts: %04x pm1_en: %04x pm1_cnt: %08x\n",
412 ps->pm1_sts, ps->pm1_en, ps->pm1_cnt);
413
414 for (i = 0; i < GPE0_REG_MAX; i++) {
415 ps->gpe0_sts[i] = inl(ACPI_BASE_ADDRESS + GPE0_STS(i));
416 ps->gpe0_en[i] = inl(ACPI_BASE_ADDRESS + GPE0_EN(i));
417 printk(BIOS_DEBUG, "gpe0_sts[%d]: %08x gpe0_en[%d]: %08x\n",
418 i, ps->gpe0_sts[i], i, ps->gpe0_en[i]);
419 }
420
421 soc_fill_power_state(ps);
Furquan Shaikhe48fb542017-10-17 16:00:10 -0700422}
423
424/* Reads and prints ACPI specific PM registers */
425int pmc_fill_power_state(struct chipset_power_state *ps)
426{
427 pmc_fill_pm_reg_info(ps);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800428
429 ps->prev_sleep_state = pmc_prev_sleep_state(ps);
430 printk(BIOS_DEBUG, "prev_sleep_state %d\n", ps->prev_sleep_state);
431
432 return ps->prev_sleep_state;
433}
434
Julius Wernercd49cce2019-03-05 16:53:33 -0800435#if CONFIG(PMC_GLOBAL_RESET_ENABLE_LOCK)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800436/*
437 * If possible, lock 0xcf9. Once the register is locked, it can't be changed.
438 * This lock is reset on cold boot, hard reset, soft reset and Sx.
439 */
440void pmc_global_reset_lock(void)
441{
442 /* Read PMC base address from soc */
443 uintptr_t etr = soc_read_pmc_base() + ETR;
444 uint32_t reg;
445
446 reg = read32((void *)etr);
447 if (reg & CF9_LOCK)
448 return;
449 reg |= CF9_LOCK;
450 write32((void *)etr, reg);
451}
452
453/*
454 * Enable or disable global reset. If global reset is enabled, hard reset and
455 * soft reset will trigger global reset, where both host and TXE are reset.
456 * This is cleared on cold boot, hard reset, soft reset and Sx.
457 */
458void pmc_global_reset_enable(bool enable)
459{
460 /* Read PMC base address from soc */
461 uintptr_t etr = soc_read_pmc_base() + ETR;
462 uint32_t reg;
463
464 reg = read32((void *)etr);
465 reg = enable ? reg | CF9_GLB_RST : reg & ~CF9_GLB_RST;
466 write32((void *)etr, reg);
467}
Julien Viard de Galbert2912e8e2018-08-14 16:15:26 +0200468#endif // CONFIG_PMC_GLOBAL_RESET_ENABLE_LOCK
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800469
470int vboot_platform_is_resuming(void)
471{
472 if (!(inw(ACPI_BASE_ADDRESS + PM1_STS) & WAK_STS))
473 return 0;
474
Furquan Shaikhab620182017-10-16 22:19:13 -0700475 return acpi_sleep_from_pm1(pmc_read_pm1_control()) == ACPI_S3;
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800476}
477
478/* Read and clear GPE status (defined in arch/acpi.h) */
479int acpi_get_gpe(int gpe)
480{
481 int bank;
482 uint32_t mask, sts;
483 struct stopwatch sw;
484 int rc = 0;
485
486 if (gpe < 0 || gpe > GPE_MAX)
487 return -1;
488
489 bank = gpe / 32;
490 mask = 1 << (gpe % 32);
491
492 /* Wait up to 1ms for GPE status to clear */
493 stopwatch_init_msecs_expire(&sw, 1);
494 do {
495 if (stopwatch_expired(&sw))
496 return rc;
497
498 sts = inl(ACPI_BASE_ADDRESS + GPE0_STS(bank));
499 if (sts & mask) {
500 outl(mask, ACPI_BASE_ADDRESS + GPE0_STS(bank));
501 rc = 1;
502 }
503 } while (sts & mask);
504
505 return rc;
506}
507
508/*
509 * The PM1 control is set to S5 when vboot requests a reboot because the power
510 * state code above may not have collected its data yet. Therefore, set it to
511 * S5 when vboot requests a reboot. That's necessary if vboot fails in the
512 * resume path and requests a reboot. This prevents a reboot loop where the
513 * error is continually hit on the failing vboot resume path.
514 */
515void vboot_platform_prepare_reboot(void)
516{
Furquan Shaikhab620182017-10-16 22:19:13 -0700517 uint32_t pm1_cnt;
518 pm1_cnt = (pmc_read_pm1_control() & ~(SLP_TYP)) |
519 (SLP_TYP_S5 << SLP_TYP_SHIFT);
520 pmc_write_pm1_control(pm1_cnt);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800521}
522
523void poweroff(void)
524{
525 pmc_enable_pm1_control(SLP_EN | (SLP_TYP_S5 << SLP_TYP_SHIFT));
526
527 /*
528 * Setting SLP_TYP_S5 in PM1 triggers SLP_SMI, which is handled by SMM
529 * to transition to S5 state. If halt is called in SMM, then it prevents
530 * the SMI handler from being triggered and system never enters S5.
531 */
532 if (!ENV_SMM)
533 halt();
534}
535
536void pmc_gpe_init(void)
537{
538 uint32_t gpio_cfg = 0;
539 uint32_t gpio_cfg_reg;
540 uint8_t dw0, dw1, dw2;
541
542 /* Read PMC base address from soc. This is implemented in soc */
543 uintptr_t pmc_bar = soc_read_pmc_base();
544
545 /*
546 * Get the dwX values for pmc gpe settings.
547 */
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700548 soc_get_gpi_gpe_configs(&dw0, &dw1, &dw2);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800549
550 const uint32_t gpio_cfg_mask =
551 (GPE0_DWX_MASK << GPE0_DW_SHIFT(0)) |
552 (GPE0_DWX_MASK << GPE0_DW_SHIFT(1)) |
553 (GPE0_DWX_MASK << GPE0_DW_SHIFT(2));
554
555 /* Making sure that bad values don't bleed into the other fields */
556 dw0 &= GPE0_DWX_MASK;
557 dw1 &= GPE0_DWX_MASK;
558 dw2 &= GPE0_DWX_MASK;
559
560 /*
561 * Route the GPIOs to the GPE0 block. Determine that all values
562 * are different, and if they aren't use the reset values.
563 */
564 if (dw0 == dw1 || dw1 == dw2) {
565 printk(BIOS_INFO, "PMC: Using default GPE route.\n");
566 gpio_cfg = read32((void *)pmc_bar + GPIO_GPE_CFG);
567
568 dw0 = (gpio_cfg >> GPE0_DW_SHIFT(0)) & GPE0_DWX_MASK;
569 dw1 = (gpio_cfg >> GPE0_DW_SHIFT(1)) & GPE0_DWX_MASK;
570 dw2 = (gpio_cfg >> GPE0_DW_SHIFT(2)) & GPE0_DWX_MASK;
571 } else {
572 gpio_cfg |= (uint32_t) dw0 << GPE0_DW_SHIFT(0);
573 gpio_cfg |= (uint32_t) dw1 << GPE0_DW_SHIFT(1);
574 gpio_cfg |= (uint32_t) dw2 << GPE0_DW_SHIFT(2);
575 }
576
577 gpio_cfg_reg = read32((void *)pmc_bar + GPIO_GPE_CFG) & ~gpio_cfg_mask;
578 gpio_cfg_reg |= gpio_cfg & gpio_cfg_mask;
579
580 write32((void *)pmc_bar + GPIO_GPE_CFG, gpio_cfg_reg);
581
582 /* Set the routes in the GPIO communities as well. */
583 gpio_route_gpe(dw0, dw1, dw2);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800584}