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
|
/*
* Copyright 2014 GE Intelligent Platforms, Inc.
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License as
* published by the Free Software Foundation; either version 2 of
* the License, or (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
#include <common.h>
#include <asm/cache.h>
#include <mmu.h>
#include <mach/mmu.h>
int arch_remap_range(void *virt_addr, phys_addr_t phys_addr, size_t size, unsigned flags)
{
uint32_t ptr, start, tsize, valid, wimge, pte_flags;
unsigned long epn;
phys_addr_t rpn = 0;
int esel = 0;
if (phys_addr != virt_to_phys(virt_addr))
return -ENOSYS;
switch (flags) {
case MAP_UNCACHED:
pte_flags = MAS2_I;
break;
case MAP_CACHED:
pte_flags = 0;
break;
default:
return -EINVAL;
}
ptr = start = (uint32_t)virt_addr;
wimge = pte_flags | MAS2_M;
while (ptr < (start + size)) {
esel = e500_find_tlb_idx((void *)ptr, 1);
if (esel != -1)
break;
e500_read_tlbcam_entry(esel, &valid, &tsize, &epn,
&rpn);
if (flags & MAS2_I) {
flush_dcache();
invalidate_icache();
}
e500_set_tlb(1, epn, rpn, MAS3_SX|MAS3_SW|MAS3_SR,
(u8)wimge, 0, esel, tsize, 1);
/* convert tsize to bytes to increment address. */
ptr += (1ULL << ((tsize) + 10));
}
return 0;
}
|