blob: 564aacb55e157fbbdaa648b0155fdca427f6a2f8 [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
16#include <arch/io.h>
Kyösti Mälkki13f66502019-03-03 08:01:05 +020017#include <device/mmio.h>
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080018#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
Arthur Heymansea6dd742019-05-25 10:32:31 +020029static struct chipset_power_state power_state;
Shaunak Sahaf0738722017-10-02 15:01:33 -070030
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))
Arthur Heymansea6dd742019-05-25 10:32:31 +020040 return &power_state;
Shaunak Sahaf0738722017-10-02 15:01:33 -070041
42 return ptr;
43}
44
45static void migrate_power_state(int is_recovery)
46{
47 struct chipset_power_state *ps_cbmem;
Shaunak Sahaf0738722017-10-02 15:01:33 -070048
Shaunak Sahaf0738722017-10-02 15:01:33 -070049 ps_cbmem = cbmem_add(CBMEM_ID_POWER_STATE, sizeof(*ps_cbmem));
50
51 if (ps_cbmem == NULL) {
52 printk(BIOS_DEBUG, "Not adding power state to cbmem!\n");
53 return;
54 }
Arthur Heymansea6dd742019-05-25 10:32:31 +020055 memcpy(ps_cbmem, &power_state, sizeof(*ps_cbmem));
Shaunak Sahaf0738722017-10-02 15:01:33 -070056}
57ROMSTAGE_CBMEM_INIT_HOOK(migrate_power_state)
58
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080059static void print_num_status_bits(int num_bits, uint32_t status,
60 const char *const bit_names[])
61{
62 int i;
63
64 if (!status)
65 return;
66
67 for (i = num_bits - 1; i >= 0; i--) {
68 if (status & (1 << i)) {
69 if (bit_names[i])
70 printk(BIOS_DEBUG, "%s ", bit_names[i]);
71 else
72 printk(BIOS_DEBUG, "BIT%d ", i);
73 }
74 }
75}
76
Aaron Durbin64031672018-04-21 14:45:32 -060077__weak uint32_t soc_get_smi_status(uint32_t generic_sts)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -080078{
79 return generic_sts;
80}
81
Subrata Banik9b98feb2017-12-13 11:02:43 +053082/*
83 * Set PMC register to know which state system should be after
84 * power reapplied
85 */
Aaron Durbin64031672018-04-21 14:45:32 -060086__weak void pmc_soc_restore_power_failure(void)
Subrata Banik9b98feb2017-12-13 11:02:43 +053087{
88 /*
89 * SoC code should set PMC config register in order to set
90 * MAINBOARD_POWER_ON bit as per EDS.
91 */
92}
93
Bora Guvendik3cb0e272018-09-28 16:19:00 -070094int acpi_get_sleep_type(void)
95{
96 struct chipset_power_state *ps;
John Zhao0ccfc0c2018-10-16 10:48:00 -070097 int prev_sleep_state = ACPI_S0;
Bora Guvendik3cb0e272018-09-28 16:19:00 -070098
99 ps = pmc_get_power_state();
John Zhao0ccfc0c2018-10-16 10:48:00 -0700100 if (ps)
101 prev_sleep_state = ps->prev_sleep_state;
102
103 return prev_sleep_state;
Bora Guvendik3cb0e272018-09-28 16:19:00 -0700104}
105
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800106static uint32_t pmc_reset_smi_status(void)
107{
108 uint32_t smi_sts = inl(ACPI_BASE_ADDRESS + SMI_STS);
109 outl(smi_sts, ACPI_BASE_ADDRESS + SMI_STS);
110
111 return soc_get_smi_status(smi_sts);
112}
113
114static uint32_t print_smi_status(uint32_t smi_sts)
115{
116 size_t array_size;
117 const char *const *smi_arr;
118
119 if (!smi_sts)
120 return 0;
121
122 printk(BIOS_DEBUG, "SMI_STS: ");
123
124 smi_arr = soc_smi_sts_array(&array_size);
125
126 print_num_status_bits(array_size, smi_sts, smi_arr);
127 printk(BIOS_DEBUG, "\n");
128
129 return smi_sts;
130}
131
Shaunak Saha25cc76f2017-09-28 15:13:05 -0700132/*
133 * Update supplied events in PM1_EN register. This does not disable any already
134 * set events.
135 */
136void pmc_update_pm1_enable(u16 events)
137{
138 u16 pm1_en = pmc_read_pm1_enable();
139 pm1_en |= events;
140 pmc_enable_pm1(pm1_en);
141}
142
143/* Read events set in PM1_EN register. */
144uint16_t pmc_read_pm1_enable(void)
145{
146 return inw(ACPI_BASE_ADDRESS + PM1_EN);
147}
148
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800149uint32_t pmc_clear_smi_status(void)
150{
151 uint32_t sts = pmc_reset_smi_status();
152
153 return print_smi_status(sts);
154}
155
156uint32_t pmc_get_smi_en(void)
157{
158 return inl(ACPI_BASE_ADDRESS + SMI_EN);
159}
160
161void pmc_enable_smi(uint32_t mask)
162{
163 uint32_t smi_en = inl(ACPI_BASE_ADDRESS + SMI_EN);
164 smi_en |= mask;
165 outl(smi_en, ACPI_BASE_ADDRESS + SMI_EN);
166}
167
168void pmc_disable_smi(uint32_t mask)
169{
170 uint32_t smi_en = inl(ACPI_BASE_ADDRESS + SMI_EN);
171 smi_en &= ~mask;
172 outl(smi_en, ACPI_BASE_ADDRESS + SMI_EN);
173}
174
175/* PM1 */
176void pmc_enable_pm1(uint16_t events)
177{
178 outw(events, ACPI_BASE_ADDRESS + PM1_EN);
179}
180
Furquan Shaikhab620182017-10-16 22:19:13 -0700181uint32_t pmc_read_pm1_control(void)
182{
183 return inl(ACPI_BASE_ADDRESS + PM1_CNT);
184}
185
186void pmc_write_pm1_control(uint32_t pm1_cnt)
187{
188 outl(pm1_cnt, ACPI_BASE_ADDRESS + PM1_CNT);
189}
190
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800191void pmc_enable_pm1_control(uint32_t mask)
192{
Furquan Shaikhab620182017-10-16 22:19:13 -0700193 uint32_t pm1_cnt = pmc_read_pm1_control();
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800194 pm1_cnt |= mask;
Furquan Shaikhab620182017-10-16 22:19:13 -0700195 pmc_write_pm1_control(pm1_cnt);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800196}
197
198void pmc_disable_pm1_control(uint32_t mask)
199{
Furquan Shaikhab620182017-10-16 22:19:13 -0700200 uint32_t pm1_cnt = pmc_read_pm1_control();
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800201 pm1_cnt &= ~mask;
Furquan Shaikhab620182017-10-16 22:19:13 -0700202 pmc_write_pm1_control(pm1_cnt);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800203}
204
205static uint16_t reset_pm1_status(void)
206{
207 uint16_t pm1_sts = inw(ACPI_BASE_ADDRESS + PM1_STS);
208 outw(pm1_sts, ACPI_BASE_ADDRESS + PM1_STS);
209 return pm1_sts;
210}
211
212static uint16_t print_pm1_status(uint16_t pm1_sts)
213{
214 static const char *const pm1_sts_bits[] = {
215 [0] = "TMROF",
216 [5] = "GBL",
217 [8] = "PWRBTN",
218 [10] = "RTC",
219 [11] = "PRBTNOR",
220 [13] = "USB",
221 [14] = "PCIEXPWAK",
222 [15] = "WAK",
223 };
224
225 if (!pm1_sts)
226 return 0;
227
228 printk(BIOS_SPEW, "PM1_STS: ");
229 print_num_status_bits(ARRAY_SIZE(pm1_sts_bits), pm1_sts, pm1_sts_bits);
230 printk(BIOS_SPEW, "\n");
231
232 return pm1_sts;
233}
234
235uint16_t pmc_clear_pm1_status(void)
236{
237 return print_pm1_status(reset_pm1_status());
238}
239
240/* TCO */
241
242static uint32_t print_tco_status(uint32_t tco_sts)
243{
244 size_t array_size;
245 const char *const *tco_arr;
246
247 if (!tco_sts)
248 return 0;
249
250 printk(BIOS_DEBUG, "TCO_STS: ");
251
252 tco_arr = soc_tco_sts_array(&array_size);
253
254 print_num_status_bits(array_size, tco_sts, tco_arr);
255 printk(BIOS_DEBUG, "\n");
256
257 return tco_sts;
258}
259
260uint32_t pmc_clear_tco_status(void)
261{
Subrata Banik7bc4dc52018-05-17 18:40:32 +0530262 return print_tco_status(tco_reset_status());
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800263}
264
265/* GPE */
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700266static void pmc_enable_gpe(int gpe, uint32_t mask)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800267{
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700268 uint32_t gpe0_en = inl(ACPI_BASE_ADDRESS + GPE0_EN(gpe));
269 gpe0_en |= mask;
270 outl(gpe0_en, ACPI_BASE_ADDRESS + GPE0_EN(gpe));
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800271}
272
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700273static void pmc_disable_gpe(int gpe, uint32_t mask)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800274{
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700275 uint32_t gpe0_en = inl(ACPI_BASE_ADDRESS + GPE0_EN(gpe));
276 gpe0_en &= ~mask;
277 outl(gpe0_en, ACPI_BASE_ADDRESS + GPE0_EN(gpe));
278}
279
280void pmc_enable_std_gpe(uint32_t mask)
281{
282 pmc_enable_gpe(GPE_STD, mask);
283}
284
285void pmc_disable_std_gpe(uint32_t mask)
286{
287 pmc_disable_gpe(GPE_STD, mask);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800288}
289
290void pmc_disable_all_gpe(void)
291{
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700292 int i;
293 for (i = 0; i < GPE0_REG_MAX; i++)
294 pmc_disable_gpe(i, ~0);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800295}
296
297/* Clear the gpio gpe0 status bits in ACPI registers */
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700298static void pmc_clear_gpi_gpe_status(void)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800299{
300 int i;
301
302 for (i = 0; i < GPE0_REG_MAX; i++) {
303 /* This is reserved GPE block and specific to chipset */
304 if (i == GPE_STD)
305 continue;
306 uint32_t gpe_sts = inl(ACPI_BASE_ADDRESS + GPE0_STS(i));
307 outl(gpe_sts, ACPI_BASE_ADDRESS + GPE0_STS(i));
308 }
309}
310
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700311static uint32_t reset_std_gpe_status(void)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800312{
313 uint32_t gpe_sts = inl(ACPI_BASE_ADDRESS + GPE0_STS(GPE_STD));
314 outl(gpe_sts, ACPI_BASE_ADDRESS + GPE0_STS(GPE_STD));
315 return gpe_sts;
316}
317
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700318static uint32_t print_std_gpe_sts(uint32_t gpe_sts)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800319{
320 size_t array_size;
321 const char *const *sts_arr;
322
323 if (!gpe_sts)
324 return gpe_sts;
325
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700326 printk(BIOS_DEBUG, "GPE0 STD STS: ");
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800327
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700328 sts_arr = soc_std_gpe_sts_array(&array_size);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800329 print_num_status_bits(array_size, gpe_sts, sts_arr);
330 printk(BIOS_DEBUG, "\n");
331
332 return gpe_sts;
333}
334
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700335static void pmc_clear_std_gpe_status(void)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800336{
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700337 print_std_gpe_sts(reset_std_gpe_status());
338}
339
340void pmc_clear_all_gpe_status(void)
341{
342 pmc_clear_std_gpe_status();
343 pmc_clear_gpi_gpe_status();
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800344}
345
Aaron Durbin64031672018-04-21 14:45:32 -0600346__weak
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800347void soc_clear_pm_registers(uintptr_t pmc_bar)
348{
349}
350
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700351void pmc_clear_prsts(void)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800352{
353 uint32_t prsts;
354 uintptr_t pmc_bar;
355
356 /* Read PMC base address from soc */
357 pmc_bar = soc_read_pmc_base();
358
359 prsts = read32((void *)(pmc_bar + PRSTS));
360 write32((void *)(pmc_bar + PRSTS), prsts);
361
362 soc_clear_pm_registers(pmc_bar);
363}
364
Aaron Durbin64031672018-04-21 14:45:32 -0600365__weak
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800366int soc_prev_sleep_state(const struct chipset_power_state *ps,
367 int prev_sleep_state)
368{
369 return prev_sleep_state;
370}
371
372/*
373 * Returns prev_sleep_state and also prints all power management registers.
Jonathan Neuschäfer5268b762018-02-12 12:24:25 +0100374 * Calls soc_prev_sleep_state which may be implemented by SOC.
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800375 */
376static int pmc_prev_sleep_state(const struct chipset_power_state *ps)
377{
378 /* Default to S0. */
379 int prev_sleep_state = ACPI_S0;
380
381 if (ps->pm1_sts & WAK_STS) {
382 switch (acpi_sleep_from_pm1(ps->pm1_cnt)) {
383 case ACPI_S3:
Julius Wernercd49cce2019-03-05 16:53:33 -0800384 if (CONFIG(HAVE_ACPI_RESUME))
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800385 prev_sleep_state = ACPI_S3;
386 break;
387 case ACPI_S5:
388 prev_sleep_state = ACPI_S5;
389 break;
390 }
391
392 /* Clear SLP_TYP. */
Furquan Shaikhab620182017-10-16 22:19:13 -0700393 pmc_write_pm1_control(ps->pm1_cnt & ~(SLP_TYP));
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800394 }
395 return soc_prev_sleep_state(ps, prev_sleep_state);
396}
397
Furquan Shaikhe48fb542017-10-17 16:00:10 -0700398void pmc_fill_pm_reg_info(struct chipset_power_state *ps)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800399{
400 int i;
401
Furquan Shaikhe48fb542017-10-17 16:00:10 -0700402 memset(ps, 0, sizeof(*ps));
403
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800404 ps->pm1_sts = inw(ACPI_BASE_ADDRESS + PM1_STS);
405 ps->pm1_en = inw(ACPI_BASE_ADDRESS + PM1_EN);
Furquan Shaikhab620182017-10-16 22:19:13 -0700406 ps->pm1_cnt = pmc_read_pm1_control();
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800407
408 printk(BIOS_DEBUG, "pm1_sts: %04x pm1_en: %04x pm1_cnt: %08x\n",
409 ps->pm1_sts, ps->pm1_en, ps->pm1_cnt);
410
411 for (i = 0; i < GPE0_REG_MAX; i++) {
412 ps->gpe0_sts[i] = inl(ACPI_BASE_ADDRESS + GPE0_STS(i));
413 ps->gpe0_en[i] = inl(ACPI_BASE_ADDRESS + GPE0_EN(i));
414 printk(BIOS_DEBUG, "gpe0_sts[%d]: %08x gpe0_en[%d]: %08x\n",
415 i, ps->gpe0_sts[i], i, ps->gpe0_en[i]);
416 }
417
418 soc_fill_power_state(ps);
Furquan Shaikhe48fb542017-10-17 16:00:10 -0700419}
420
421/* Reads and prints ACPI specific PM registers */
422int pmc_fill_power_state(struct chipset_power_state *ps)
423{
424 pmc_fill_pm_reg_info(ps);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800425
426 ps->prev_sleep_state = pmc_prev_sleep_state(ps);
427 printk(BIOS_DEBUG, "prev_sleep_state %d\n", ps->prev_sleep_state);
428
429 return ps->prev_sleep_state;
430}
431
Julius Wernercd49cce2019-03-05 16:53:33 -0800432#if CONFIG(PMC_GLOBAL_RESET_ENABLE_LOCK)
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800433/*
434 * If possible, lock 0xcf9. Once the register is locked, it can't be changed.
435 * This lock is reset on cold boot, hard reset, soft reset and Sx.
436 */
437void pmc_global_reset_lock(void)
438{
439 /* Read PMC base address from soc */
440 uintptr_t etr = soc_read_pmc_base() + ETR;
441 uint32_t reg;
442
443 reg = read32((void *)etr);
444 if (reg & CF9_LOCK)
445 return;
446 reg |= CF9_LOCK;
447 write32((void *)etr, reg);
448}
449
450/*
451 * Enable or disable global reset. If global reset is enabled, hard reset and
452 * soft reset will trigger global reset, where both host and TXE are reset.
453 * This is cleared on cold boot, hard reset, soft reset and Sx.
454 */
455void pmc_global_reset_enable(bool enable)
456{
457 /* Read PMC base address from soc */
458 uintptr_t etr = soc_read_pmc_base() + ETR;
459 uint32_t reg;
460
461 reg = read32((void *)etr);
462 reg = enable ? reg | CF9_GLB_RST : reg & ~CF9_GLB_RST;
463 write32((void *)etr, reg);
464}
Julien Viard de Galbert2912e8e2018-08-14 16:15:26 +0200465#endif // CONFIG_PMC_GLOBAL_RESET_ENABLE_LOCK
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800466
467int vboot_platform_is_resuming(void)
468{
469 if (!(inw(ACPI_BASE_ADDRESS + PM1_STS) & WAK_STS))
470 return 0;
471
Furquan Shaikhab620182017-10-16 22:19:13 -0700472 return acpi_sleep_from_pm1(pmc_read_pm1_control()) == ACPI_S3;
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800473}
474
475/* Read and clear GPE status (defined in arch/acpi.h) */
476int acpi_get_gpe(int gpe)
477{
478 int bank;
479 uint32_t mask, sts;
480 struct stopwatch sw;
481 int rc = 0;
482
483 if (gpe < 0 || gpe > GPE_MAX)
484 return -1;
485
486 bank = gpe / 32;
487 mask = 1 << (gpe % 32);
488
489 /* Wait up to 1ms for GPE status to clear */
490 stopwatch_init_msecs_expire(&sw, 1);
491 do {
492 if (stopwatch_expired(&sw))
493 return rc;
494
495 sts = inl(ACPI_BASE_ADDRESS + GPE0_STS(bank));
496 if (sts & mask) {
497 outl(mask, ACPI_BASE_ADDRESS + GPE0_STS(bank));
498 rc = 1;
499 }
500 } while (sts & mask);
501
502 return rc;
503}
504
505/*
506 * The PM1 control is set to S5 when vboot requests a reboot because the power
507 * state code above may not have collected its data yet. Therefore, set it to
508 * S5 when vboot requests a reboot. That's necessary if vboot fails in the
509 * resume path and requests a reboot. This prevents a reboot loop where the
510 * error is continually hit on the failing vboot resume path.
511 */
512void vboot_platform_prepare_reboot(void)
513{
Furquan Shaikhab620182017-10-16 22:19:13 -0700514 uint32_t pm1_cnt;
515 pm1_cnt = (pmc_read_pm1_control() & ~(SLP_TYP)) |
516 (SLP_TYP_S5 << SLP_TYP_SHIFT);
517 pmc_write_pm1_control(pm1_cnt);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800518}
519
520void poweroff(void)
521{
522 pmc_enable_pm1_control(SLP_EN | (SLP_TYP_S5 << SLP_TYP_SHIFT));
523
524 /*
525 * Setting SLP_TYP_S5 in PM1 triggers SLP_SMI, which is handled by SMM
526 * to transition to S5 state. If halt is called in SMM, then it prevents
527 * the SMI handler from being triggered and system never enters S5.
528 */
529 if (!ENV_SMM)
530 halt();
531}
532
533void pmc_gpe_init(void)
534{
535 uint32_t gpio_cfg = 0;
536 uint32_t gpio_cfg_reg;
537 uint8_t dw0, dw1, dw2;
538
539 /* Read PMC base address from soc. This is implemented in soc */
540 uintptr_t pmc_bar = soc_read_pmc_base();
541
542 /*
543 * Get the dwX values for pmc gpe settings.
544 */
Furquan Shaikhc4e652f2017-10-11 14:44:29 -0700545 soc_get_gpi_gpe_configs(&dw0, &dw1, &dw2);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800546
547 const uint32_t gpio_cfg_mask =
548 (GPE0_DWX_MASK << GPE0_DW_SHIFT(0)) |
549 (GPE0_DWX_MASK << GPE0_DW_SHIFT(1)) |
550 (GPE0_DWX_MASK << GPE0_DW_SHIFT(2));
551
552 /* Making sure that bad values don't bleed into the other fields */
553 dw0 &= GPE0_DWX_MASK;
554 dw1 &= GPE0_DWX_MASK;
555 dw2 &= GPE0_DWX_MASK;
556
557 /*
558 * Route the GPIOs to the GPE0 block. Determine that all values
559 * are different, and if they aren't use the reset values.
560 */
561 if (dw0 == dw1 || dw1 == dw2) {
562 printk(BIOS_INFO, "PMC: Using default GPE route.\n");
563 gpio_cfg = read32((void *)pmc_bar + GPIO_GPE_CFG);
564
565 dw0 = (gpio_cfg >> GPE0_DW_SHIFT(0)) & GPE0_DWX_MASK;
566 dw1 = (gpio_cfg >> GPE0_DW_SHIFT(1)) & GPE0_DWX_MASK;
567 dw2 = (gpio_cfg >> GPE0_DW_SHIFT(2)) & GPE0_DWX_MASK;
568 } else {
569 gpio_cfg |= (uint32_t) dw0 << GPE0_DW_SHIFT(0);
570 gpio_cfg |= (uint32_t) dw1 << GPE0_DW_SHIFT(1);
571 gpio_cfg |= (uint32_t) dw2 << GPE0_DW_SHIFT(2);
572 }
573
574 gpio_cfg_reg = read32((void *)pmc_bar + GPIO_GPE_CFG) & ~gpio_cfg_mask;
575 gpio_cfg_reg |= gpio_cfg & gpio_cfg_mask;
576
577 write32((void *)pmc_bar + GPIO_GPE_CFG, gpio_cfg_reg);
578
579 /* Set the routes in the GPIO communities as well. */
580 gpio_route_gpe(dw0, dw1, dw2);
Shaunak Saha9dffbdd2017-03-08 19:27:17 -0800581}