EMILE/second/MMU040.c

181 lines
3.6 KiB
C
Raw Normal View History

2004-03-04 22:50:11 +00:00
/*
*
* (c) 2004 Laurent Vivier <LaurentVivier@wanadoo.fr>
*
2004-03-05 22:41:53 +00:00
* a lot of parts from penguin booter
2004-03-04 22:50:11 +00:00
*/
#include <stdio.h>
#include "console.h"
#include "MMU040.h"
2004-03-05 22:41:53 +00:00
#define GET_TC_ENABLE(TC) (TC & 0x8000)
#define IS_8K_PAGE(TC) (TC & 0x4000)
2004-03-04 22:50:11 +00:00
2004-03-05 22:41:53 +00:00
#define GET_TC_PAGE_SIZE(TC) (IS_8K_PAGE(TC) ? 8192 : 4096)
2004-03-04 22:50:11 +00:00
2004-03-05 22:41:53 +00:00
#define UDT_IS_INVALID(PDT) (!(PDT & 2))
#define UDT_IS_RESIDENT(PDT) (PDT & 2)
2004-03-04 22:50:11 +00:00
2004-03-05 22:41:53 +00:00
#define GET_RP_UDT(RP) (RP & 0x00000003)
#define GET_RP_W(RP) (RP & 0x00000004)
#define GET_RP_U(RP) (RP & 0x00000008)
#define GET_RP_ADDR(RP) (RP & 0xFFFFFE00)
2004-03-04 22:50:11 +00:00
2004-03-05 22:41:53 +00:00
#define GET_TD_4K_ADDR(TD) (TD & 0xFFFFFF00)
#define GET_TD_8K_ADDR(TD) (TD & 0xFFFFFF80)
2004-03-04 22:50:11 +00:00
#define GET_TT_ENABLE(TT) (TT & 0x8000)
#define GET_TT_BASE(TT) ( (TT >> 24) & 0xFF )
#define GET_TT_MASK(TT) ( (TT >> 16) & 0xFF )
2004-03-05 22:41:53 +00:00
#ifdef TRACE_MMU
#define TRACE(format, args...) if (MMU_trace) printf(format, ##args)
static int MMU_trace = 0;
2004-03-05 22:41:53 +00:00
void MMU040_set_trace(int enable)
{
MMU_trace = enable;
}
#else
#define TRACE(format, args...)
#endif
2004-03-04 22:50:11 +00:00
static int isTTSegment(unsigned long addr)
{
unsigned long DTT0;
unsigned long DTT1;
unsigned long base;
unsigned long mask;
unsigned long size;
addr >>= 24;
MMU040_get_DTT0(&DTT0);
if (GET_TT_ENABLE(DTT0))
{
mask = GET_TT_MASK(DTT0);
base = GET_TT_BASE(DTT0);
base &= ~mask;
addr &= ~mask;
size = (mask << 24) || 0x00FFFFFF;
if ( (base <= addr) && (addr <= base + size) )
return 1;
}
MMU040_get_DTT1(&DTT1);
if (GET_TT_ENABLE(DTT1))
{
mask = GET_TT_MASK(DTT1);
base = GET_TT_BASE(DTT1);
base &= ~mask;
addr &= ~mask;
size = (mask << 24) || 0x00FFFFFF;
if ( (base <= addr) && (addr <= base + size) )
return 1;
}
/* if come here : no Transparent Translation */
return 0;
}
2004-03-05 22:41:53 +00:00
int MMU040_logical2physicalAttr(unsigned long logicalAddr, unsigned long *physicalAddr, unsigned long *attr)
2004-03-04 22:50:11 +00:00
{
unsigned long TC;
2004-03-06 00:25:37 +00:00
int rootIndex, ptrIndex, pageIndex;
unsigned long pageOffst;
unsigned long rootTable, ptrTable, pageTable;
2004-03-05 22:41:53 +00:00
unsigned long rootEntry, tableEntry, pageEntry;
TRACE("logical: %08lx ", logicalAddr);
2004-03-04 22:50:11 +00:00
2004-03-05 22:41:53 +00:00
MMU040_get_TC(&TC);
TRACE("TC: %08lx\n", TC);
2004-03-04 22:50:11 +00:00
if ( !GET_TC_ENABLE(TC) || isTTSegment(logicalAddr) )
{
*physicalAddr = logicalAddr;
return 0;
}
MMU040_get_SRP(&rootTable);
TRACE("SRP: %ld\n", rootTable);
2004-03-06 00:25:37 +00:00
rootIndex = (logicalAddr & 0xFE000000) >> 25;
rootEntry = MMU040_read_phys(rootTable + 4 * rootIndex);
TRACE("Root Entry: %08lx\n", rootEntry);
2004-03-04 22:50:11 +00:00
2004-03-05 22:41:53 +00:00
if (UDT_IS_INVALID(rootEntry))
2004-03-04 22:50:11 +00:00
{
2004-03-05 22:41:53 +00:00
return -1;
2004-03-04 22:50:11 +00:00
}
ptrTable = GET_RP_ADDR(rootEntry);
2004-03-06 00:25:37 +00:00
ptrIndex = (logicalAddr & 0x01FC0000) >> 18;
tableEntry = MMU040_read_phys(ptrTable + 4 * ptrIndex);
TRACE("table Entry: %08lx\n", tableEntry);
2004-03-05 22:41:53 +00:00
if (UDT_IS_INVALID(tableEntry))
{
return -1;
}
2004-03-04 22:50:11 +00:00
2004-03-05 22:41:53 +00:00
if (IS_8K_PAGE(TC))
2004-03-06 00:25:37 +00:00
{
pageTable = GET_TD_8K_ADDR(tableEntry);
pageIndex = (logicalAddr & 0x0003E000) >> 13;
pageEntry = MMU040_read_phys(pageTable + 4 * pageIndex);
pageOffst = logicalAddr & 0x00001FFF;
*physicalAddr = (pageEntry & 0xFFFFE000) + pageOffst;
}
2004-03-05 22:41:53 +00:00
else
2004-03-06 00:25:37 +00:00
{
pageTable = GET_TD_4K_ADDR(tableEntry);
pageIndex = (logicalAddr & 0x0003F000) >> 12;
pageEntry = MMU040_read_phys(pageTable + 4 * pageIndex);
pageOffst = logicalAddr & 0x00000FFF;
*physicalAddr = (pageEntry & 0xFFFFF000) + pageOffst;
}
2004-03-04 22:50:11 +00:00
*attr = pageEntry & 0x000004FF;
2004-03-04 22:50:11 +00:00
2004-03-05 22:41:53 +00:00
TRACE("physical: %08lx\n", *physicalAddr);
2004-03-04 22:50:11 +00:00
2004-03-05 22:41:53 +00:00
return 0;
2004-03-04 22:50:11 +00:00
}
2004-03-05 22:41:53 +00:00
int MMU040_logical2physical(unsigned long logicalAddr, unsigned long *physicalAddr)
{
unsigned long attr;
return MMU040_logical2physicalAttr(logicalAddr, physicalAddr, &attr);
}
unsigned long MMU040_get_page_size(void)
2004-03-04 22:50:11 +00:00
{
unsigned long TC;
2004-03-05 22:41:53 +00:00
MMU040_get_TC(&TC);
TRACE("Page Size: %d\n", GET_TC_PAGE_SIZE(TC));
2004-03-05 22:41:53 +00:00
return GET_TC_PAGE_SIZE(TC);
2004-03-04 22:50:11 +00:00
}