connectTheSignalSlot.c 3.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149
  1. /*
  2. * arch/arm/mm/cache-l2x0.c - L210/L220 cache controller support
  3. *
  4. * Copyright (C) 2007 ARM Limited
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License version 2 as
  8. * published by the Free Software Foundation.
  9. *
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License
  16. * along with this program; if not, write to the Free Software
  17. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  18. */
  19. #include <linux/err.h>
  20. #include <linux/init.h>
  21. #include <linux/spinlock.h>
  22. #include <linux/io.h>
  23. #include <linux/of.h>
  24. #include <linux/of_address.h>
  25. #include <asm/cacheflush.h>
  26. #include <asm/hardware/cache-l2x0.h>
  27. #include "cache-aurora-l2.h"
  28. #define CACHE_LINE_SIZE 32
  29. static void __iomem *l2x0_base;
  30. static DEFINE_RAW_SPINLOCK(l2x0_lock);
  31. static u32 l2x0_way_mask; /* Bitmask of active ways */
  32. static u32 l2x0_size;
  33. static unsigned long sync_reg_offset = L2X0_CACHE_SYNC;
  34. /* Aurora don't have the cache ID register available, so we have to
  35. * pass it though the device tree */
  36. static u32 cache_id_part_number_from_dt;
  37. struct l2x0_regs l2x0_saved_regs;
  38. struct l2x0_of_data {
  39. void (*setup)(const struct device_node *, u32 *, u32 *);
  40. void (*save)(void);
  41. struct outer_cache_fns outer_cache;
  42. };
  43. static bool of_init = false;
  44. static inline void cache_wait_way(void __iomem *reg, unsigned long mask)
  45. {
  46. /* wait for cache operation by line or way to complete */
  47. while (readl_relaxed(reg) & mask)
  48. cpu_relax();
  49. }
  50. #ifdef CONFIG_CACHE_PL310
  51. static inline void cache_wait(void __iomem *reg, unsigned long mask)
  52. {
  53. /* cache operations by line are atomic on PL310 */
  54. }
  55. #else
  56. #define cache_wait cache_wait_way
  57. #endif
  58. static inline void cache_sync(void)
  59. {
  60. void __iomem *base = l2x0_base;
  61. writel_relaxed(0, base + sync_reg_offset);
  62. cache_wait(base + L2X0_CACHE_SYNC, 1);
  63. }
  64. static inline void l2x0_clean_line(unsigned long addr)
  65. {
  66. void __iomem *base = l2x0_base;
  67. cache_wait(base + L2X0_CLEAN_LINE_PA, 1);
  68. writel_relaxed(addr, base + L2X0_CLEAN_LINE_PA);
  69. }
  70. static inline void l2x0_inv_line(unsigned long addr)
  71. {
  72. void __iomem *base = l2x0_base;
  73. cache_wait(base + L2X0_INV_LINE_PA, 1);
  74. writel_relaxed(addr, base + L2X0_INV_LINE_PA);
  75. }
  76. #if defined(CONFIG_PL310_ERRATA_588369) || defined(CONFIG_PL310_ERRATA_727915)
  77. static inline void debug_writel(unsigned long val)
  78. {
  79. if (outer_cache.set_debug)
  80. outer_cache.set_debug(val);
  81. }
  82. static void pl310_set_debug(unsigned long val)
  83. {
  84. writel_relaxed(val, l2x0_base + L2X0_DEBUG_CTRL);
  85. }
  86. #else
  87. /* Optimised out for non-errata case */
  88. static inline void debug_writel(unsigned long val)
  89. {
  90. }
  91. #define pl310_set_debug NULL
  92. #endif
  93. #ifdef CONFIG_PL310_ERRATA_588369
  94. static inline void l2x0_flush_line(unsigned long addr)
  95. {
  96. void __iomem *base = l2x0_base;
  97. /* Clean by PA followed by Invalidate by PA */
  98. cache_wait(base + L2X0_CLEAN_LINE_PA, 1);
  99. writel_relaxed(addr, base + L2X0_CLEAN_LINE_PA);
  100. cache_wait(base + L2X0_INV_LINE_PA, 1);
  101. writel_relaxed(addr, base + L2X0_INV_LINE_PA);
  102. }
  103. #else
  104. static inline void l2x0_flush_line(unsigned long addr)
  105. {
  106. void __iomem *base = l2x0_base;
  107. cache_wait(base + L2X0_CLEAN_INV_LINE_PA, 1);
  108. writel_relaxed(addr, base + L2X0_CLEAN_INV_LINE_PA);
  109. }
  110. #endif
  111. static void l2x0_cache_sync(void)
  112. {
  113. unsigned long flags;
  114. raw_spin_lock_irqsave(&l2x0_lock, flags);
  115. cache_sync();
  116. raw_spin_unlock_irqrestore(&l2x0_lock, flags);
  117. }
  118. static void __l2x0_flush_all(void)
  119. {
  120. debug_writel(0x03);
  121. writel_relaxed(l2x0_way_mask, l2x0_base + L2X0_CLEAN_INV_WAY);
  122. cache_wait_way(l2x0_base + L2X0_CLEAN_INV_WAY, l2x0_way_mask);
  123. cache_sync();
  124. debug_writel(0x00);
  125. }
  126. static void l2x0_flush_all(void)