2018-03-26 23:04:16 +00:00
|
|
|
/*
|
2018-08-05 11:40:32 +00:00
|
|
|
* Copyright (c) 2018 naehrwert
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
|
|
* under the terms and conditions of the GNU General Public License,
|
|
|
|
* version 2, as published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
|
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
|
|
* more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License
|
|
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/
|
2018-03-26 23:04:16 +00:00
|
|
|
|
2018-08-13 08:58:24 +00:00
|
|
|
#include "../soc/cluster.h"
|
|
|
|
#include "../soc/i2c.h"
|
|
|
|
#include "../soc/clock.h"
|
|
|
|
#include "../utils/util.h"
|
|
|
|
#include "../soc/pmc.h"
|
|
|
|
#include "../soc/t210.h"
|
|
|
|
#include "../power/max77620.h"
|
2018-09-18 20:38:54 +00:00
|
|
|
#include "../power/max7762x.h"
|
2018-03-14 23:26:19 +00:00
|
|
|
|
|
|
|
void _cluster_enable_power()
|
|
|
|
{
|
2018-09-18 20:38:54 +00:00
|
|
|
u8 tmp = i2c_recv_byte(I2C_5, MAX77620_I2C_ADDR, MAX77620_REG_AME_GPIO);
|
|
|
|
i2c_send_byte(I2C_5, MAX77620_I2C_ADDR, MAX77620_REG_AME_GPIO, tmp & 0xDF);
|
|
|
|
i2c_send_byte(I2C_5, MAX77620_I2C_ADDR, MAX77620_REG_GPIO5, 0x09);
|
2018-03-14 23:26:19 +00:00
|
|
|
|
2018-08-05 11:40:32 +00:00
|
|
|
// Enable cores power.
|
2018-09-18 20:38:54 +00:00
|
|
|
i2c_send_byte(I2C_5, MAX77621_CPU_I2C_ADDR, MAX77621_CONTROL1_REG, MAX77621_NFSR_ENABLE);
|
|
|
|
i2c_send_byte(I2C_5, MAX77621_CPU_I2C_ADDR, MAX77621_CONTROL2_REG, MAX77621_T_JUNCTION_120 | MAX77621_CKKADV_TRIP_DISABLE | MAX77621_INDUCTOR_NOMINAL);
|
|
|
|
i2c_send_byte(I2C_5, MAX77621_CPU_I2C_ADDR, MAX77621_VOUT_REG, MAX77621_VOUT_ENABLE | 0x37);
|
|
|
|
i2c_send_byte(I2C_5, MAX77621_CPU_I2C_ADDR, MAX77621_VOUT_DVC_REG, MAX77621_VOUT_ENABLE | 0x37);
|
2018-03-14 23:26:19 +00:00
|
|
|
}
|
|
|
|
|
2018-09-18 20:38:54 +00:00
|
|
|
int _cluster_pmc_enable_partition(u32 part, u32 toggle, bool enable)
|
2018-03-14 23:26:19 +00:00
|
|
|
{
|
2018-08-05 11:40:32 +00:00
|
|
|
// Check if the partition has already been turned on.
|
2018-09-18 20:38:54 +00:00
|
|
|
if (enable && PMC(APBDEV_PMC_PWRGATE_STATUS) & part)
|
2018-05-01 05:15:48 +00:00
|
|
|
return 1;
|
2018-03-14 23:26:19 +00:00
|
|
|
|
|
|
|
u32 i = 5001;
|
|
|
|
while (PMC(APBDEV_PMC_PWRGATE_TOGGLE) & 0x100)
|
|
|
|
{
|
2018-07-04 15:39:26 +00:00
|
|
|
usleep(1);
|
2018-03-14 23:26:19 +00:00
|
|
|
i--;
|
|
|
|
if (i < 1)
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2018-09-18 20:38:54 +00:00
|
|
|
PMC(APBDEV_PMC_PWRGATE_TOGGLE) = toggle | (enable ? 0x100 : 0);
|
2018-03-14 23:26:19 +00:00
|
|
|
|
|
|
|
i = 5001;
|
|
|
|
while (i > 0)
|
|
|
|
{
|
|
|
|
if (PMC(APBDEV_PMC_PWRGATE_STATUS) & part)
|
|
|
|
break;
|
2018-07-04 15:39:26 +00:00
|
|
|
usleep(1);
|
2018-03-14 23:26:19 +00:00
|
|
|
i--;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
2018-05-01 05:15:48 +00:00
|
|
|
void cluster_boot_cpu0(u32 entry)
|
2018-03-14 23:26:19 +00:00
|
|
|
{
|
2018-08-05 11:40:32 +00:00
|
|
|
// Set ACTIVE_CLUSER to FAST.
|
2018-03-14 23:26:19 +00:00
|
|
|
FLOW_CTLR(FLOW_CTLR_BPMP_CLUSTER_CONTROL) &= 0xFFFFFFFE;
|
|
|
|
|
|
|
|
_cluster_enable_power();
|
|
|
|
|
2018-05-01 05:15:48 +00:00
|
|
|
if (!(CLOCK(CLK_RST_CONTROLLER_PLLX_BASE) & 0x40000000))
|
2018-03-14 23:26:19 +00:00
|
|
|
{
|
2018-05-01 05:15:48 +00:00
|
|
|
CLOCK(CLK_RST_CONTROLLER_PLLX_MISC_3) &= 0xFFFFFFF7;
|
2018-07-04 15:39:26 +00:00
|
|
|
usleep(2);
|
2018-05-01 05:15:48 +00:00
|
|
|
CLOCK(CLK_RST_CONTROLLER_PLLX_BASE) = 0x80404E02;
|
|
|
|
CLOCK(CLK_RST_CONTROLLER_PLLX_BASE) = 0x404E02;
|
2018-06-08 09:42:24 +00:00
|
|
|
CLOCK(CLK_RST_CONTROLLER_PLLX_MISC) = (CLOCK(CLK_RST_CONTROLLER_PLLX_MISC) & 0xFFFBFFFF) | 0x40000;
|
2018-05-01 05:15:48 +00:00
|
|
|
CLOCK(CLK_RST_CONTROLLER_PLLX_BASE) = 0x40404E02;
|
2018-03-14 23:26:19 +00:00
|
|
|
}
|
2018-05-01 05:15:48 +00:00
|
|
|
while (!(CLOCK(CLK_RST_CONTROLLER_PLLX_BASE) & 0x8000000))
|
2018-03-14 23:26:19 +00:00
|
|
|
;
|
|
|
|
|
2018-08-05 11:40:32 +00:00
|
|
|
// Configure MSELECT source and enable clock.
|
2018-06-08 09:42:24 +00:00
|
|
|
CLOCK(CLK_RST_CONTROLLER_CLK_SOURCE_MSELECT) = (CLOCK(CLK_RST_CONTROLLER_CLK_SOURCE_MSELECT) & 0x1FFFFF00) | 6;
|
|
|
|
CLOCK(CLK_RST_CONTROLLER_CLK_OUT_ENB_V) = (CLOCK(CLK_RST_CONTROLLER_CLK_OUT_ENB_V) & 0xFFFFFFF7) | 8;
|
2018-05-01 05:15:48 +00:00
|
|
|
|
2018-08-05 11:40:32 +00:00
|
|
|
// Configure initial CPU clock frequency and enable clock.
|
2018-05-01 05:15:48 +00:00
|
|
|
CLOCK(CLK_RST_CONTROLLER_CCLK_BURST_POLICY) = 0x20008888;
|
|
|
|
CLOCK(CLK_RST_CONTROLLER_SUPER_CCLK_DIVIDER) = 0x80000000;
|
|
|
|
CLOCK(CLK_RST_CONTROLLER_CLK_ENB_V_SET) = 1;
|
2018-03-14 23:26:19 +00:00
|
|
|
|
|
|
|
clock_enable_coresight();
|
|
|
|
|
2018-08-05 11:40:32 +00:00
|
|
|
// CAR2PMC_CPU_ACK_WIDTH should be set to 0.
|
2018-06-08 09:42:24 +00:00
|
|
|
CLOCK(CLK_RST_CONTROLLER_CPU_SOFTRST_CTRL2) &= 0xFFFFF000;
|
2018-03-14 23:26:19 +00:00
|
|
|
|
2018-08-05 11:40:32 +00:00
|
|
|
// Enable CPU rail.
|
2018-09-18 20:38:54 +00:00
|
|
|
_cluster_pmc_enable_partition(1, 0, true);
|
|
|
|
// Enable cluster 0 non-CPU.
|
|
|
|
_cluster_pmc_enable_partition(0x8000, 15, true);
|
2018-08-05 11:40:32 +00:00
|
|
|
// Enable CE0.
|
2018-03-14 23:26:19 +00:00
|
|
|
_cluster_pmc_enable_partition(0x4000, 14);
|
|
|
|
|
2018-08-05 11:40:32 +00:00
|
|
|
// Request and wait for RAM repair.
|
2018-03-14 23:26:19 +00:00
|
|
|
FLOW_CTLR(FLOW_CTLR_RAM_REPAIR) = 1;
|
|
|
|
while (!(FLOW_CTLR(FLOW_CTLR_RAM_REPAIR) & 2))
|
|
|
|
;
|
|
|
|
|
|
|
|
EXCP_VEC(0x100) = 0;
|
|
|
|
|
2018-08-05 11:40:32 +00:00
|
|
|
// Set reset vector.
|
2018-03-14 23:26:19 +00:00
|
|
|
SB(SB_AA64_RESET_LOW) = entry | 1;
|
|
|
|
SB(SB_AA64_RESET_HIGH) = 0;
|
2018-08-05 11:40:32 +00:00
|
|
|
// Non-secure reset vector write disable.
|
2018-05-01 05:15:48 +00:00
|
|
|
SB(SB_CSR) = 2;
|
|
|
|
(void)SB(SB_CSR);
|
2018-03-14 23:26:19 +00:00
|
|
|
|
2018-08-05 11:40:32 +00:00
|
|
|
// Clear MSELECT reset.
|
2018-03-14 23:26:19 +00:00
|
|
|
CLOCK(CLK_RST_CONTROLLER_RST_DEVICES_V) &= 0xFFFFFFF7;
|
2018-08-05 11:40:32 +00:00
|
|
|
// Clear NONCPU reset.
|
2018-05-01 05:15:48 +00:00
|
|
|
CLOCK(CLK_RST_CONTROLLER_RST_CPUG_CMPLX_CLR) = 0x20000000;
|
2018-08-05 11:40:32 +00:00
|
|
|
// Clear CPU{0,1,2,3} POR and CORE, CX0, L2, and DBG reset.
|
2018-03-14 23:26:19 +00:00
|
|
|
CLOCK(CLK_RST_CONTROLLER_RST_CPUG_CMPLX_CLR) = 0x411F000F;
|
|
|
|
}
|