Merge "GIC-600: Fix power up sequence" into integration

This commit is contained in:
Sandrine Bailleux 2019-11-15 09:23:58 +00:00 committed by TrustedFirmware Code Review
commit 52c96f2a75
1 changed files with 39 additions and 26 deletions

View File

@ -1,14 +1,14 @@
/* /*
* Copyright (c) 2017, ARM Limited and Contributors. All rights reserved. * Copyright (c) 2017-2019, ARM Limited and Contributors. All rights reserved.
* *
* SPDX-License-Identifier: BSD-3-Clause * SPDX-License-Identifier: BSD-3-Clause
*/ */
/* /*
* Driver for GIC600-specific features. This driver only overrides APIs that are * Driver for GIC-600 specific features. This driver only overrides
* different to those generic ones in GICv3 driver. * APIs that are different to those generic ones in GICv3 driver.
* *
* GIC600 supports independently power-gating redistributor interface. * GIC-600 supports independently power-gating redistributor interface.
*/ */
#include <assert.h> #include <assert.h>
@ -18,22 +18,28 @@
#include "gicv3_private.h" #include "gicv3_private.h"
/* GIC600-specific register offsets */ /* GIC-600 specific register offsets */
#define GICR_PWRR 0x24 #define GICR_PWRR 0x24
/* GICR_PWRR fields */ /* GICR_PWRR fields */
#define PWRR_RDPD_SHIFT 0 #define PWRR_RDPD_SHIFT 0
#define PWRR_RDAG_SHIFT 1
#define PWRR_RDGPD_SHIFT 2 #define PWRR_RDGPD_SHIFT 2
#define PWRR_RDGPO_SHIFT 3 #define PWRR_RDGPO_SHIFT 3
#define PWRR_RDPD (1 << PWRR_RDPD_SHIFT)
#define PWRR_RDAG (1 << PWRR_RDAG_SHIFT)
#define PWRR_RDGPD (1 << PWRR_RDGPD_SHIFT) #define PWRR_RDGPD (1 << PWRR_RDGPD_SHIFT)
#define PWRR_RDGPO (1 << PWRR_RDGPO_SHIFT) #define PWRR_RDGPO (1 << PWRR_RDGPO_SHIFT)
/* Values to write to GICR_PWRR register to power redistributor */ /*
* Values to write to GICR_PWRR register to power redistributor
* for operating through the core (GICR_PWRR.RDAG = 0)
*/
#define PWRR_ON (0 << PWRR_RDPD_SHIFT) #define PWRR_ON (0 << PWRR_RDPD_SHIFT)
#define PWRR_OFF (1 << PWRR_RDPD_SHIFT) #define PWRR_OFF (1 << PWRR_RDPD_SHIFT)
/* GIC600-specific accessor functions */ /* GIC-600 specific accessor functions */
static void gicr_write_pwrr(uintptr_t base, unsigned int val) static void gicr_write_pwrr(uintptr_t base, unsigned int val)
{ {
mmio_write_32(base + GICR_PWRR, val); mmio_write_32(base + GICR_PWRR, val);
@ -44,39 +50,46 @@ static uint32_t gicr_read_pwrr(uintptr_t base)
return mmio_read_32(base + GICR_PWRR); return mmio_read_32(base + GICR_PWRR);
} }
static int gicr_group_powering_down(uint32_t pwrr) static void gicr_wait_group_not_in_transit(uintptr_t base)
{ {
/* /* Check group not transitioning: RDGPD == RDGPO */
* Whether the redistributor group power down operation is in transit: while (((gicr_read_pwrr(base) & PWRR_RDGPD) >> PWRR_RDGPD_SHIFT) !=
* i.e. it's intending to, but not finished yet. ((gicr_read_pwrr(base) & PWRR_RDGPO) >> PWRR_RDGPO_SHIFT))
*/ ;
return ((pwrr & PWRR_RDGPD) && !(pwrr & PWRR_RDGPO));
} }
static void gic600_pwr_on(uintptr_t base) static void gic600_pwr_on(uintptr_t base)
{ {
do { /* Wait until group not transitioning */
gicr_wait_group_not_in_transit(base);
/* Power on redistributor */ /* Power on redistributor */
gicr_write_pwrr(base, PWRR_ON); gicr_write_pwrr(base, PWRR_ON);
/* Wait until the power on state is reflected */ /*
while (gicr_read_pwrr(base) & PWRR_RDGPO) * Wait until the power on state is reflected.
; * If RDPD == 0 then powered on.
*/
} while ((gicr_read_pwrr(base) & PWRR_RDPD) != PWRR_ON);
} }
static void gic600_pwr_off(uintptr_t base) static void gic600_pwr_off(uintptr_t base)
{ {
/* Wait until group not transitioning */
gicr_wait_group_not_in_transit(base);
/* Power off redistributor */ /* Power off redistributor */
gicr_write_pwrr(base, PWRR_OFF); gicr_write_pwrr(base, PWRR_OFF);
/* /*
* If this is the last man, turning this redistributor frame off will * If this is the last man, turning this redistributor frame off will
* result in the group itself being powered off. In that case, wait as * result in the group itself being powered off and RDGPD = 1.
* long as it's in transition, or has aborted the transition altogether * In that case, wait as long as it's in transition, or has aborted
* for any reason. * the transition altogether for any reason.
*/ */
if (gicr_read_pwrr(base) & PWRR_RDGPD) { if ((gicr_read_pwrr(base) & PWRR_RDGPD) != 0) {
while (gicr_group_powering_down(gicr_read_pwrr(base))) /* Wait until group not transitioning */
; gicr_wait_group_not_in_transit(base);
} }
} }
@ -91,7 +104,7 @@ void gicv3_distif_post_restore(unsigned int proc_num)
} }
/* /*
* Power off GIC600 redistributor * Power off GIC-600 redistributor
*/ */
void gicv3_rdistif_off(unsigned int proc_num) void gicv3_rdistif_off(unsigned int proc_num)
{ {
@ -109,7 +122,7 @@ void gicv3_rdistif_off(unsigned int proc_num)
} }
/* /*
* Power on GIC600 redistributor * Power on GIC-600 redistributor
*/ */
void gicv3_rdistif_on(unsigned int proc_num) void gicv3_rdistif_on(unsigned int proc_num)
{ {