59 lines
1.4 KiB
C
59 lines
1.4 KiB
C
/*
|
|
* Copyright (c) 2019, ARM Limited and Contributors. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <arch_helpers.h>
|
|
#include <common/debug.h>
|
|
#include <lib/mmio.h>
|
|
#include <plat_debug.h>
|
|
#include <platform_def.h>
|
|
#include <spm.h>
|
|
|
|
void circular_buffer_setup(void)
|
|
{
|
|
/* Clear DBG_CONTROL.lastpc_disable to enable circular buffer */
|
|
sync_writel(CA15M_DBG_CONTROL,
|
|
mmio_read_32(CA15M_DBG_CONTROL) & ~(BIT_CA15M_LASTPC_DIS));
|
|
}
|
|
|
|
void circular_buffer_unlock(void)
|
|
{
|
|
unsigned int i;
|
|
|
|
/* Disable big vproc external off (set CPU_EXT_BUCK_ISO to 0x0) */
|
|
sync_writel(VPROC_EXT_CTL, mmio_read_32(VPROC_EXT_CTL) & ~(0x1 << 1));
|
|
|
|
/* Release vproc apb mask (set 0x0C53_2008[1] to 0x0) */
|
|
sync_writel(CA15M_PWR_RST_CTL, mmio_read_32(CA15M_PWR_RST_CTL) & ~(0x1 << 1));
|
|
|
|
for (i = 1; i <= 4; ++i)
|
|
sync_writel(MP1_CPUTOP_PWR_CON + i * 4,
|
|
(mmio_read_32(MP1_CPUTOP_PWR_CON + i * 4) & ~(0x4))|(0x4));
|
|
|
|
/* Set DFD.en */
|
|
sync_writel(DFD_INTERNAL_CTL, 0x1);
|
|
}
|
|
|
|
void circular_buffer_lock(void)
|
|
{
|
|
/* Clear DFD.en */
|
|
sync_writel(DFD_INTERNAL_CTL, 0x0);
|
|
}
|
|
|
|
void clear_all_on_mux(void)
|
|
{
|
|
sync_writel(MCU_ALL_PWR_ON_CTRL,
|
|
mmio_read_32(MCU_ALL_PWR_ON_CTRL) & ~(1 << 2));
|
|
sync_writel(MCU_ALL_PWR_ON_CTRL,
|
|
mmio_read_32(MCU_ALL_PWR_ON_CTRL) & ~(1 << 1));
|
|
}
|
|
|
|
void l2c_parity_check_setup(void)
|
|
{
|
|
/* Enable DBG_CONTROL.l2parity_en */
|
|
sync_writel(CA15M_DBG_CONTROL,
|
|
mmio_read_32(CA15M_DBG_CONTROL) | BIT_CA15M_L2PARITY_EN);
|
|
}
|