LXR linux/arch/nds32/kernel/atl2c.c

   1// SPDX-License-Identifier: GPL-2.0
   2// Copyright (C) 2005-2017 Andes Technology Corporation
   3
   4#include <linux/compiler.h>
   5#include <linux/of_address.h>
   6#include <linux/of_fdt.h>
   7#include <linux/of_platform.h>
   8#include <asm/l2_cache.h>
   9
  10void __iomem *atl2c_base;
  11static const struct of_device_id atl2c_ids[] __initconst = {
  12        {.compatible = "andestech,atl2c",},
  13        {}
  14};
  15
  16static int __init atl2c_of_init(void)
  17{
  18        struct device_node *np;
  19        struct resource res;
  20        unsigned long tmp = 0;
  21        unsigned long l2set, l2way, l2clsz;
  22
  23        if (!(__nds32__mfsr(NDS32_SR_MSC_CFG) & MSC_CFG_mskL2C))
  24                return -ENODEV;
  25
  26        np = of_find_matching_node(NULL, atl2c_ids);
  27        if (!np)
  28                return -ENODEV;
  29
  30        if (of_address_to_resource(np, 0, &res))
  31                return -ENODEV;
  32
  33        atl2c_base = ioremap(res.start, resource_size(&res));
  34        if (!atl2c_base)
  35                return -ENOMEM;
  36
  37        l2set =
  38            64 << ((L2C_R_REG(L2_CA_CONF_OFF) & L2_CA_CONF_mskL2SET) >>
  39                   L2_CA_CONF_offL2SET);
  40        l2way =
  41            1 +
  42            ((L2C_R_REG(L2_CA_CONF_OFF) & L2_CA_CONF_mskL2WAY) >>
  43             L2_CA_CONF_offL2WAY);
  44        l2clsz =
  45            4 << ((L2C_R_REG(L2_CA_CONF_OFF) & L2_CA_CONF_mskL2CLSZ) >>
  46                  L2_CA_CONF_offL2CLSZ);
  47        pr_info("L2:%luKB/%luS/%luW/%luB\n",
  48                l2set * l2way * l2clsz / 1024, l2set, l2way, l2clsz);
  49
  50        tmp = L2C_R_REG(L2CC_PROT_OFF);
  51        tmp &= ~L2CC_PROT_mskMRWEN;
  52        L2C_W_REG(L2CC_PROT_OFF, tmp);
  53
  54        tmp = L2C_R_REG(L2CC_SETUP_OFF);
  55        tmp &= ~L2CC_SETUP_mskPART;
  56        L2C_W_REG(L2CC_SETUP_OFF, tmp);
  57
  58        tmp = L2C_R_REG(L2CC_CTRL_OFF);
  59        tmp |= L2CC_CTRL_mskEN;
  60        L2C_W_REG(L2CC_CTRL_OFF, tmp);
  61
  62        return 0;
  63}
  64
  65subsys_initcall(atl2c_of_init);
  66