From cf8a3c3d7075abad3c88cd604f8add4d06898abc Mon Sep 17 00:00:00 2001 From: Hsiangkai Wang Date: Tue, 5 Feb 2013 11:55:37 +0800 Subject: nds32: add new target type nds32_v2, nds32_v3, nds32_v3m Add target code for Andes targets. Change-Id: Ibf0e1b61b06127ca7d9ed502d98d7e2aeebbbe82 Signed-off-by: Hsiangkai Wang Reviewed-on: http://openocd.zylin.com/1259 Tested-by: jenkins Reviewed-by: Spencer Oliver --- src/target/nds32_tlb.c | 80 ++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 80 insertions(+) create mode 100644 src/target/nds32_tlb.c (limited to 'src/target/nds32_tlb.c') diff --git a/src/target/nds32_tlb.c b/src/target/nds32_tlb.c new file mode 100644 index 0000000..58322cf --- /dev/null +++ b/src/target/nds32_tlb.c @@ -0,0 +1,80 @@ +/*************************************************************************** + * Copyright (C) 2013 Andes Technology * + * Hsiangkai Wang * + * * + * 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. * + * * + * You should have received a copy of the GNU General Public License * + * along with this program; if not, write to the * + * Free Software Foundation, Inc., * + * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. * + ***************************************************************************/ +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include "nds32_aice.h" +#include "nds32_tlb.h" + +int nds32_probe_tlb(struct nds32 *nds32, const uint32_t virtual_address, + uint32_t *physical_address) +{ + struct target *target = nds32->target; + struct aice_port_s *aice = target_to_aice(target); + + return aice_read_tlb(aice, virtual_address, physical_address); +} + +struct page_table_walker_info_s page_table_info[PAGE_SIZE_NUM] = { + /* 4K page */ + {0xFFC00000, 20, 0x003FF000, 10, 0x00000FFF, 0xFFFFF000, 0xFFFFF000, 0xFFFFF000}, + /* 8K page */ + {0xFF000000, 22, 0x00FFE000, 11, 0x00001FFF, 0xFFFFF000, 0xFFFFE000, 0xFFFFE000}, +}; + +int nds32_walk_page_table(struct nds32 *nds32, const uint32_t virtual_address, + uint32_t *physical_address) +{ + struct target *target = nds32->target; + uint32_t value_mr1; + uint32_t load_address; + uint32_t L1_page_table_entry; + uint32_t L2_page_table_entry; + uint32_t page_size_index = nds32->mmu_config.default_min_page_size; + struct page_table_walker_info_s *page_table_info_p = + &(page_table_info[page_size_index]); + + /* Read L1 Physical Page Table */ + nds32_get_mapped_reg(nds32, MR1, &value_mr1); + load_address = (value_mr1 & page_table_info_p->L1_base_mask) | + ((virtual_address & page_table_info_p->L1_offset_mask) >> + page_table_info_p->L1_offset_shift); + /* load_address is physical address */ + nds32_read_buffer(target, load_address, 4, (uint8_t *)&L1_page_table_entry); + + /* Read L2 Physical Page Table */ + if (L1_page_table_entry & 0x1) /* L1_PTE not present */ + return ERROR_FAIL; + + load_address = (L1_page_table_entry & page_table_info_p->L2_base_mask) | + ((virtual_address & page_table_info_p->L2_offset_mask) >> + page_table_info_p->L2_offset_shift); + /* load_address is physical address */ + nds32_read_buffer(target, load_address, 4, (uint8_t *)&L2_page_table_entry); + + if ((L2_page_table_entry & 0x1) != 0x1) /* L2_PTE not valid */ + return ERROR_FAIL; + + *physical_address = (L2_page_table_entry & page_table_info_p->ppn_mask) | + (virtual_address & page_table_info_p->va_offset_mask); + + return ERROR_OK; +} -- cgit v1.1