Quelle  mach-vf610.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Copyright 2012-2013 Freescale Semiconductor, Inc.
 */

#include <linux/of_address.h>
#include <linux/of_platform.h>
#include <linux/io.h>

#include <linux/irqchip.h>
#include <asm/mach/arch.h>
#include <asm/hardware/cache-l2x0.h>

#include "common.h"
#include "hardware.h"

#define MSCM_CPxCOUNT  0x00c
#define MSCM_CPxCFG1  0x014

static void __init vf610_detect_cpu(void)
{
 struct device_node *np;
 u32 cpxcount, cpxcfg1;
 unsigned int cpu_type;
 void __iomem *mscm;

 np = of_find_compatible_node(NULL, NULL, "fsl,vf610-mscm-cpucfg");
 if (WARN_ON(!np))
  return;

 mscm = of_iomap(np, 0);
 of_node_put(np);

 if (WARN_ON(!mscm))
  return;

 cpxcount = readl_relaxed(mscm + MSCM_CPxCOUNT);
 cpxcfg1  = readl_relaxed(mscm + MSCM_CPxCFG1);

 iounmap(mscm);

 cpu_type = cpxcount ? MXC_CPU_VF600 : MXC_CPU_VF500;

 if (cpxcfg1)
  cpu_type |= MXC_CPU_VFx10;

 mxc_set_cpu_type(cpu_type);
}

static void __init vf610_init_machine(void)
{
 vf610_detect_cpu();

 of_platform_default_populate(NULL, NULL, NULL);
}

static const char * const vf610_dt_compat[] __initconst = {
 "fsl,vf500",
 "fsl,vf510",
 "fsl,vf600",
 "fsl,vf610",
 "fsl,vf610m4",
 NULL,
};

DT_MACHINE_START(VYBRID_VF610, "Freescale Vybrid VF5xx/VF6xx (Device Tree)")
 .l2c_aux_val = 0,
 .l2c_aux_mask = ~0,
 .init_machine   = vf610_init_machine,
 .dt_compat = vf610_dt_compat,
MACHINE_END