static void
initialize_coherency_fabric(void)
{
uint32_t val, cpus, mask;
cpus = platform_get_ncpus();
mask = (1 << cpus) - 1;
val = read_coher_fabric(COHER_FABRIC_CTRL);
val |= (mask << 24);
write_coher_fabric(COHER_FABRIC_CTRL, val);
val = read_coher_fabric(COHER_FABRIC_CONF);
val |= (mask << 24);
write_coher_fabric(COHER_FABRIC_CONF, val);
}
void
armadaxp_init_coher_fabric(void)
{
uint32_t val, cpus, mask;
cpus = platform_get_ncpus();
mask = (1 << cpus) - 1;
val = read_coher_fabric(COHER_FABRIC_CTRL);
val |= (mask << 24);
write_coher_fabric(COHER_FABRIC_CTRL, val);
val = read_coher_fabric(COHER_FABRIC_CONF);
val |= (mask << 24);
val |= (1 << 15);
write_coher_fabric(COHER_FABRIC_CONF, val);
}
void
armadaxp_l2_init(void)
{
u_int32_t reg;
/* Set L2 policy */
reg = read_l2_cache(ARMADAXP_L2_AUX_CTRL);
reg &= ~(L2_WBWT_MODE_MASK);
reg &= ~(L2_REP_STRAT_MASK);
reg |= L2_REP_STRAT_SEMIPLRU;
reg |= L2_WBWT_MODE_WT;
write_l2_cache(ARMADAXP_L2_AUX_CTRL, reg);
/* Invalidate l2 cache */
armadaxp_l2_idcache_inv_all();
/* Clear pending L2 interrupts */
write_l2_cache(ARMADAXP_L2_INT_CAUSE, 0x1ff);
/* Enable l2 cache */
reg = read_l2_cache(ARMADAXP_L2_CTRL);
write_l2_cache(ARMADAXP_L2_CTRL, reg | L2_ENABLE);
/*
* For debug purposes
* Configure and enable counter
*/
write_l2_cache(ARMADAXP_L2_CNTR_CONF(0), 0xf0000 | (4 << 2));
write_l2_cache(ARMADAXP_L2_CNTR_CONF(1), 0xf0000 | (2 << 2));
write_l2_cache(ARMADAXP_L2_CNTR_CTRL, 0x303);
/*
* Enable Cache maintenance operation propagation in coherency fabric
* Change point of coherency and point of unification to DRAM.
*/
reg = read_coher_fabric(COHER_FABRIC_CFU);
reg |= (1 << 17) | (1 << 18);
write_coher_fabric(COHER_FABRIC_CFU, reg);
/* Coherent IO Bridge initialization */
reg = read_coher_fabric(COHER_FABRIC_CIB_CTRL);
reg &= ~(7 << 16);
reg |= (7 << 16);
write_coher_fabric(COHER_FABRIC_CIB_CTRL, reg);
}
int
platform_get_ncpus(void)
{
#if !defined(SMP)
return (1);
#else
return ((read_coher_fabric(COHER_FABRIC_CONF) & 0xf) + 1);
#endif
}
static int
platform_get_ncpus(void)
{
return ((read_coher_fabric(COHER_FABRIC_CONF) & 0xf) + 1);
}
