18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Copyright 2012-2013 Freescale Semiconductor, Inc.
48c2ecf20Sopenharmony_ci */
58c2ecf20Sopenharmony_ci
68c2ecf20Sopenharmony_ci#include <linux/of_address.h>
78c2ecf20Sopenharmony_ci#include <linux/of_platform.h>
88c2ecf20Sopenharmony_ci#include <linux/io.h>
98c2ecf20Sopenharmony_ci
108c2ecf20Sopenharmony_ci#include <linux/irqchip.h>
118c2ecf20Sopenharmony_ci#include <asm/mach/arch.h>
128c2ecf20Sopenharmony_ci#include <asm/hardware/cache-l2x0.h>
138c2ecf20Sopenharmony_ci
148c2ecf20Sopenharmony_ci#include "common.h"
158c2ecf20Sopenharmony_ci#include "hardware.h"
168c2ecf20Sopenharmony_ci
178c2ecf20Sopenharmony_ci#define MSCM_CPxCOUNT		0x00c
188c2ecf20Sopenharmony_ci#define MSCM_CPxCFG1		0x014
198c2ecf20Sopenharmony_ci
208c2ecf20Sopenharmony_cistatic void __init vf610_detect_cpu(void)
218c2ecf20Sopenharmony_ci{
228c2ecf20Sopenharmony_ci	struct device_node *np;
238c2ecf20Sopenharmony_ci	u32 cpxcount, cpxcfg1;
248c2ecf20Sopenharmony_ci	unsigned int cpu_type;
258c2ecf20Sopenharmony_ci	void __iomem *mscm;
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_ci	np = of_find_compatible_node(NULL, NULL, "fsl,vf610-mscm-cpucfg");
288c2ecf20Sopenharmony_ci	if (WARN_ON(!np))
298c2ecf20Sopenharmony_ci		return;
308c2ecf20Sopenharmony_ci
318c2ecf20Sopenharmony_ci	mscm = of_iomap(np, 0);
328c2ecf20Sopenharmony_ci	of_node_put(np);
338c2ecf20Sopenharmony_ci
348c2ecf20Sopenharmony_ci	if (WARN_ON(!mscm))
358c2ecf20Sopenharmony_ci		return;
368c2ecf20Sopenharmony_ci
378c2ecf20Sopenharmony_ci	cpxcount = readl_relaxed(mscm + MSCM_CPxCOUNT);
388c2ecf20Sopenharmony_ci	cpxcfg1  = readl_relaxed(mscm + MSCM_CPxCFG1);
398c2ecf20Sopenharmony_ci
408c2ecf20Sopenharmony_ci	iounmap(mscm);
418c2ecf20Sopenharmony_ci
428c2ecf20Sopenharmony_ci	cpu_type = cpxcount ? MXC_CPU_VF600 : MXC_CPU_VF500;
438c2ecf20Sopenharmony_ci
448c2ecf20Sopenharmony_ci	if (cpxcfg1)
458c2ecf20Sopenharmony_ci		cpu_type |= MXC_CPU_VFx10;
468c2ecf20Sopenharmony_ci
478c2ecf20Sopenharmony_ci	mxc_set_cpu_type(cpu_type);
488c2ecf20Sopenharmony_ci}
498c2ecf20Sopenharmony_ci
508c2ecf20Sopenharmony_cistatic void __init vf610_init_machine(void)
518c2ecf20Sopenharmony_ci{
528c2ecf20Sopenharmony_ci	vf610_detect_cpu();
538c2ecf20Sopenharmony_ci
548c2ecf20Sopenharmony_ci	of_platform_default_populate(NULL, NULL, NULL);
558c2ecf20Sopenharmony_ci}
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_cistatic const char * const vf610_dt_compat[] __initconst = {
588c2ecf20Sopenharmony_ci	"fsl,vf500",
598c2ecf20Sopenharmony_ci	"fsl,vf510",
608c2ecf20Sopenharmony_ci	"fsl,vf600",
618c2ecf20Sopenharmony_ci	"fsl,vf610",
628c2ecf20Sopenharmony_ci	"fsl,vf610m4",
638c2ecf20Sopenharmony_ci	NULL,
648c2ecf20Sopenharmony_ci};
658c2ecf20Sopenharmony_ci
668c2ecf20Sopenharmony_ciDT_MACHINE_START(VYBRID_VF610, "Freescale Vybrid VF5xx/VF6xx (Device Tree)")
678c2ecf20Sopenharmony_ci	.l2c_aux_val	= 0,
688c2ecf20Sopenharmony_ci	.l2c_aux_mask	= ~0,
698c2ecf20Sopenharmony_ci	.init_machine   = vf610_init_machine,
708c2ecf20Sopenharmony_ci	.dt_compat	= vf610_dt_compat,
718c2ecf20Sopenharmony_ciMACHINE_END
72