1 /***************************************************************************
2 * Copyright (C) 2005 by Dominic Rath *
3 * Dominic.Rath@gmx.de *
5 * This program is free software; you can redistribute it and/or modify *
6 * it under the terms of the GNU General Public License as published by *
7 * the Free Software Foundation; either version 2 of the License, or *
8 * (at your option) any later version. *
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. *
15 * You should have received a copy of the GNU General Public License *
16 * along with this program; if not, write to the *
17 * Free Software Foundation, Inc., *
18 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
19 ***************************************************************************/
24 #include <helper/log.h>
26 #include "armv4_5_mmu.h"
29 uint32_t armv4_5_mmu_translate_va(struct target
*target
, struct armv4_5_mmu_common
*armv4_5_mmu
, uint32_t va
, int *type
, uint32_t *cb
, int *domain
, uint32_t *ap
)
31 uint32_t first_lvl_descriptor
= 0x0;
32 uint32_t second_lvl_descriptor
= 0x0;
33 uint32_t ttb
= armv4_5_mmu
->get_ttb(target
);
35 armv4_5_mmu_read_physical(target
, armv4_5_mmu
,
36 (ttb
& 0xffffc000) | ((va
& 0xfff00000) >> 18),
37 4, 1, (uint8_t*)&first_lvl_descriptor
);
38 first_lvl_descriptor
= target_buffer_get_u32(target
, (uint8_t*)&first_lvl_descriptor
);
40 LOG_DEBUG("1st lvl desc: %8.8" PRIx32
"", first_lvl_descriptor
);
42 if ((first_lvl_descriptor
& 0x3) == 0)
45 LOG_ERROR("Address translation failure");
46 return ERROR_TARGET_TRANSLATION_FAULT
;
49 if (!armv4_5_mmu
->has_tiny_pages
&& ((first_lvl_descriptor
& 0x3) == 3))
52 LOG_ERROR("Address translation failure");
53 return ERROR_TARGET_TRANSLATION_FAULT
;
56 /* domain is always specified in bits 8-5 */
57 *domain
= (first_lvl_descriptor
& 0x1e0) >> 5;
59 if ((first_lvl_descriptor
& 0x3) == 2)
61 /* section descriptor */
62 *type
= ARMV4_5_SECTION
;
63 *cb
= (first_lvl_descriptor
& 0xc) >> 2;
64 *ap
= (first_lvl_descriptor
& 0xc00) >> 10;
65 return (first_lvl_descriptor
& 0xfff00000) | (va
& 0x000fffff);
68 if ((first_lvl_descriptor
& 0x3) == 1)
70 /* coarse page table */
71 armv4_5_mmu_read_physical(target
, armv4_5_mmu
,
72 (first_lvl_descriptor
& 0xfffffc00) | ((va
& 0x000ff000) >> 10),
73 4, 1, (uint8_t*)&second_lvl_descriptor
);
75 else if ((first_lvl_descriptor
& 0x3) == 3)
78 armv4_5_mmu_read_physical(target
, armv4_5_mmu
,
79 (first_lvl_descriptor
& 0xfffff000) | ((va
& 0x000ffc00) >> 8),
80 4, 1, (uint8_t*)&second_lvl_descriptor
);
83 second_lvl_descriptor
= target_buffer_get_u32(target
, (uint8_t*)&second_lvl_descriptor
);
85 LOG_DEBUG("2nd lvl desc: %8.8" PRIx32
"", second_lvl_descriptor
);
87 if ((second_lvl_descriptor
& 0x3) == 0)
90 LOG_ERROR("Address translation failure");
91 return ERROR_TARGET_TRANSLATION_FAULT
;
94 /* cacheable/bufferable is always specified in bits 3-2 */
95 *cb
= (second_lvl_descriptor
& 0xc) >> 2;
97 if ((second_lvl_descriptor
& 0x3) == 1)
99 /* large page descriptor */
100 *type
= ARMV4_5_LARGE_PAGE
;
101 *ap
= (second_lvl_descriptor
& 0xff0) >> 4;
102 return (second_lvl_descriptor
& 0xffff0000) | (va
& 0x0000ffff);
105 if ((second_lvl_descriptor
& 0x3) == 2)
107 /* small page descriptor */
108 *type
= ARMV4_5_SMALL_PAGE
;
109 *ap
= (second_lvl_descriptor
& 0xff0) >> 4;
110 return (second_lvl_descriptor
& 0xfffff000) | (va
& 0x00000fff);
113 if ((second_lvl_descriptor
& 0x3) == 3)
115 /* tiny page descriptor */
116 *type
= ARMV4_5_TINY_PAGE
;
117 *ap
= (second_lvl_descriptor
& 0x30) >> 4;
118 return (second_lvl_descriptor
& 0xfffffc00) | (va
& 0x000003ff);
121 /* should not happen */
123 LOG_ERROR("Address translation failure");
124 return ERROR_TARGET_TRANSLATION_FAULT
;
127 int armv4_5_mmu_read_physical(struct target
*target
, struct armv4_5_mmu_common
*armv4_5_mmu
, uint32_t address
, uint32_t size
, uint32_t count
, uint8_t *buffer
)
131 if (target
->state
!= TARGET_HALTED
)
132 return ERROR_TARGET_NOT_HALTED
;
134 /* disable MMU and data (or unified) cache */
135 armv4_5_mmu
->disable_mmu_caches(target
, 1, 1, 0);
137 retval
= armv4_5_mmu
->read_memory(target
, address
, size
, count
, buffer
);
139 /* reenable MMU / cache */
140 armv4_5_mmu
->enable_mmu_caches(target
, armv4_5_mmu
->mmu_enabled
,
141 armv4_5_mmu
->armv4_5_cache
.d_u_cache_enabled
,
142 armv4_5_mmu
->armv4_5_cache
.i_cache_enabled
);
147 int armv4_5_mmu_write_physical(struct target
*target
, struct armv4_5_mmu_common
*armv4_5_mmu
, uint32_t address
, uint32_t size
, uint32_t count
, uint8_t *buffer
)
151 if (target
->state
!= TARGET_HALTED
)
152 return ERROR_TARGET_NOT_HALTED
;
154 /* disable MMU and data (or unified) cache */
155 armv4_5_mmu
->disable_mmu_caches(target
, 1, 1, 0);
157 retval
= armv4_5_mmu
->write_memory(target
, address
, size
, count
, buffer
);
159 /* reenable MMU / cache */
160 armv4_5_mmu
->enable_mmu_caches(target
, armv4_5_mmu
->mmu_enabled
,
161 armv4_5_mmu
->armv4_5_cache
.d_u_cache_enabled
,
162 armv4_5_mmu
->armv4_5_cache
.i_cache_enabled
);