cache-l2x0.c 2.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (C) 2019 Intel Corporation <www.intel.com>
  4. */
  5. #include <common.h>
  6. #include <command.h>
  7. #include <dm.h>
  8. #include <asm/io.h>
  9. #include <asm/pl310.h>
  10. static void l2c310_of_parse_and_init(struct udevice *dev)
  11. {
  12. u32 tag[3] = { 0, 0, 0 };
  13. u32 saved_reg, prefetch;
  14. struct pl310_regs *regs = (struct pl310_regs *)dev_read_addr(dev);
  15. /* Disable the L2 Cache */
  16. clrbits_le32(&regs->pl310_ctrl, L2X0_CTRL_EN);
  17. saved_reg = readl(&regs->pl310_aux_ctrl);
  18. if (!dev_read_u32(dev, "prefetch-data", &prefetch)) {
  19. if (prefetch)
  20. saved_reg |= L310_AUX_CTRL_DATA_PREFETCH_MASK;
  21. else
  22. saved_reg &= ~L310_AUX_CTRL_DATA_PREFETCH_MASK;
  23. }
  24. if (!dev_read_u32(dev, "prefetch-instr", &prefetch)) {
  25. if (prefetch)
  26. saved_reg |= L310_AUX_CTRL_INST_PREFETCH_MASK;
  27. else
  28. saved_reg &= ~L310_AUX_CTRL_INST_PREFETCH_MASK;
  29. }
  30. if (dev_read_bool(dev, "arm,shared-override"))
  31. saved_reg |= L310_SHARED_ATT_OVERRIDE_ENABLE;
  32. writel(saved_reg, &regs->pl310_aux_ctrl);
  33. saved_reg = readl(&regs->pl310_tag_latency_ctrl);
  34. if (!dev_read_u32_array(dev, "arm,tag-latency", tag, 3))
  35. saved_reg |= L310_LATENCY_CTRL_RD(tag[0] - 1) |
  36. L310_LATENCY_CTRL_WR(tag[1] - 1) |
  37. L310_LATENCY_CTRL_SETUP(tag[2] - 1);
  38. writel(saved_reg, &regs->pl310_tag_latency_ctrl);
  39. saved_reg = readl(&regs->pl310_data_latency_ctrl);
  40. if (!dev_read_u32_array(dev, "arm,data-latency", tag, 3))
  41. saved_reg |= L310_LATENCY_CTRL_RD(tag[0] - 1) |
  42. L310_LATENCY_CTRL_WR(tag[1] - 1) |
  43. L310_LATENCY_CTRL_SETUP(tag[2] - 1);
  44. writel(saved_reg, &regs->pl310_data_latency_ctrl);
  45. /* Enable the L2 cache */
  46. setbits_le32(&regs->pl310_ctrl, L2X0_CTRL_EN);
  47. }
  48. static int l2x0_probe(struct udevice *dev)
  49. {
  50. l2c310_of_parse_and_init(dev);
  51. return 0;
  52. }
  53. static const struct udevice_id l2x0_ids[] = {
  54. { .compatible = "arm,pl310-cache" },
  55. {}
  56. };
  57. U_BOOT_DRIVER(pl310_cache) = {
  58. .name = "pl310_cache",
  59. .id = UCLASS_CACHE,
  60. .of_match = l2x0_ids,
  61. .probe = l2x0_probe,
  62. .flags = DM_FLAG_PRE_RELOC,
  63. };