Blame view

kernel/linux-rt-4.4.41/arch/sh/mm/cache-sh3.c 2.55 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
  /*
   * arch/sh/mm/cache-sh3.c
   *
   * Copyright (C) 1999, 2000  Niibe Yutaka
   * Copyright (C) 2002 Paul Mundt
   *
   * Released under the terms of the GNU GPL v2.0.
   */
  
  #include <linux/init.h>
  #include <linux/mman.h>
  #include <linux/mm.h>
  #include <linux/threads.h>
  #include <asm/addrspace.h>
  #include <asm/page.h>
  #include <asm/pgtable.h>
  #include <asm/processor.h>
  #include <asm/cache.h>
  #include <asm/io.h>
  #include <asm/uaccess.h>
  #include <asm/pgalloc.h>
  #include <asm/mmu_context.h>
  #include <asm/cacheflush.h>
  
  /*
   * Write back the dirty D-caches, but not invalidate them.
   *
   * Is this really worth it, or should we just alias this routine
   * to __flush_purge_region too?
   *
   * START: Virtual Address (U0, P1, or P3)
   * SIZE: Size of the region.
   */
  
  static void sh3__flush_wback_region(void *start, int size)
  {
  	unsigned long v, j;
  	unsigned long begin, end;
  	unsigned long flags;
  
  	begin = (unsigned long)start & ~(L1_CACHE_BYTES-1);
  	end = ((unsigned long)start + size + L1_CACHE_BYTES-1)
  		& ~(L1_CACHE_BYTES-1);
  
  	for (v = begin; v < end; v+=L1_CACHE_BYTES) {
  		unsigned long addrstart = CACHE_OC_ADDRESS_ARRAY;
  		for (j = 0; j < current_cpu_data.dcache.ways; j++) {
  			unsigned long data, addr, p;
  
  			p = __pa(v);
  			addr = addrstart | (v & current_cpu_data.dcache.entry_mask);
  			local_irq_save(flags);
  			data = __raw_readl(addr);
  
  			if ((data & CACHE_PHYSADDR_MASK) ==
  			    (p & CACHE_PHYSADDR_MASK)) {
  				data &= ~SH_CACHE_UPDATED;
  				__raw_writel(data, addr);
  				local_irq_restore(flags);
  				break;
  			}
  			local_irq_restore(flags);
  			addrstart += current_cpu_data.dcache.way_incr;
  		}
  	}
  }
  
  /*
   * Write back the dirty D-caches and invalidate them.
   *
   * START: Virtual Address (U0, P1, or P3)
   * SIZE: Size of the region.
   */
  static void sh3__flush_purge_region(void *start, int size)
  {
  	unsigned long v;
  	unsigned long begin, end;
  
  	begin = (unsigned long)start & ~(L1_CACHE_BYTES-1);
  	end = ((unsigned long)start + size + L1_CACHE_BYTES-1)
  		& ~(L1_CACHE_BYTES-1);
  
  	for (v = begin; v < end; v+=L1_CACHE_BYTES) {
  		unsigned long data, addr;
  
  		data = (v & 0xfffffc00); /* _Virtual_ address, ~U, ~V */
  		addr = CACHE_OC_ADDRESS_ARRAY |
  			(v & current_cpu_data.dcache.entry_mask) | SH_CACHE_ASSOC;
  		__raw_writel(data, addr);
  	}
  }
  
  void __init sh3_cache_init(void)
  {
  	__flush_wback_region = sh3__flush_wback_region;
  	__flush_purge_region = sh3__flush_purge_region;
  
  	/*
  	 * No write back please
  	 *
  	 * Except I don't think there's any way to avoid the writeback.
  	 * So we just alias it to sh3__flush_purge_region(). dwmw2.
  	 */
  	__flush_invalidate_region = sh3__flush_purge_region;
  }