~hc/RK356X_SDK_RELEASE.git

..	..	@@ -1,16 +1,58 @@
	1	+// SPDX-License-Identifier: GPL-2.0-or-later
1	2	/*
2	3	* Copyright 2012-2013 Freescale Semiconductor, Inc.
3		- *
4		- * This program is free software; you can redistribute it and/or modify
5		- * it under the terms of the GNU General Public License as published by
6		- * the Free Software Foundation; either version 2 of the License, or
7		- * (at your option) any later version.
8	4	*/
9	5
	6	+#include <linux/of_address.h>
10	7	#include <linux/of_platform.h>
	8	+#include <linux/io.h>
	9	+
11	10	#include <linux/irqchip.h>
12	11	#include <asm/mach/arch.h>
13	12	#include <asm/hardware/cache-l2x0.h>
	13	+
	14	+#include "common.h"
	15	+#include "hardware.h"
	16	+
	17	+#define MSCM_CPxCOUNT 0x00c
	18	+#define MSCM_CPxCFG1 0x014
	19	+
	20	+static void __init vf610_detect_cpu(void)
	21	+{
	22	+ struct device_node *np;
	23	+ u32 cpxcount, cpxcfg1;
	24	+ unsigned int cpu_type;
	25	+ void __iomem *mscm;
	26	+
	27	+ np = of_find_compatible_node(NULL, NULL, "fsl,vf610-mscm-cpucfg");
	28	+ if (WARN_ON(!np))
	29	+ return;
	30	+
	31	+ mscm = of_iomap(np, 0);
	32	+ of_node_put(np);
	33	+
	34	+ if (WARN_ON(!mscm))
	35	+ return;
	36	+
	37	+ cpxcount = readl_relaxed(mscm + MSCM_CPxCOUNT);
	38	+ cpxcfg1 = readl_relaxed(mscm + MSCM_CPxCFG1);
	39	+
	40	+ iounmap(mscm);
	41	+
	42	+ cpu_type = cpxcount ? MXC_CPU_VF600 : MXC_CPU_VF500;
	43	+
	44	+ if (cpxcfg1)
	45	+ cpu_type \|= MXC_CPU_VFx10;
	46	+
	47	+ mxc_set_cpu_type(cpu_type);
	48	+}
	49	+
	50	+static void __init vf610_init_machine(void)
	51	+{
	52	+ vf610_detect_cpu();
	53	+
	54	+ of_platform_default_populate(NULL, NULL, NULL);
	55	+}
14	56
15	57	static const char * const vf610_dt_compat[] __initconst = {
16	58	"fsl,vf500",
..	..	@@ -24,5 +66,6 @@
24	66	DT_MACHINE_START(VYBRID_VF610, "Freescale Vybrid VF5xx/VF6xx (Device Tree)")
25	67	.l2c_aux_val = 0,
26	68	.l2c_aux_mask = ~0,
	69	+ .init_machine = vf610_init_machine,
27	70	.dt_compat = vf610_dt_compat,
28	71	MACHINE_END