/*
* ======== Mmu_enable ========
* Function to enable the MMU.
*/
Void Mmu_enable()
{
UInt16 type;
UInt key;
/* if MMU is already enabled then just return */
if (Mmu_isEnabled()) {
return;
}
key = Hwi_disable();
/* get the current enabled bits */
type = Cache_getEnabled();
if (type & Cache_Type_ALLP) {
/* invalidate all of L1 program cache */
Cache_invL1pAll();
/* disable L1P cache */
Cache_disable(Cache_Type_ALLP);
}
/* enables the MMU */
Mmu_enableAsm();
/* set cache back to initial settings */
Cache_enable(type);
Hwi_restore(key);
}
/*
* ======== Mmu_disable ========
* Function to disable the MMU.
*/
Void Mmu_disable()
{
UInt16 type;
UInt key;
/* if MMU is alreay disabled, just return */
if (!(Mmu_isEnabled())) {
return;
}
key = Hwi_disable();
/* get the current enabled bits */
type = Cache_getEnabled();
/* disable all enabled caches */
Cache_disable(type);
/* disables the MMU */
Mmu_disableAsm();
/* set cache back to initial settings */
Cache_enable(type);
Hwi_restore(key);
}
/*
* ======== Cache_startup ========
* Enable cache early if Cache_enableCache == TRUE.
*/
Void Cache_startup()
{
UInt enabled;
enabled = Cache_getEnabled();
/* disable the caches if anything is currently enabled */
if (enabled) {
Cache_invL1pAll();
Cache_disable(Cache_Type_ALL);
}
else {
Cache_invL1pAll();
Cache_invL1dAll();
}
if (Cache_enableCache) {
/*
* CCS reset doesn't disable the MMU.
* Since the MMU may still be set up and enabled
* from a previous application, disable the MMU now
* to prevent miss-configuration, when the cache gets
* enabled
*/
Mmu_disable();
Cache_enable(Cache_Type_ALL);
}
}
/*
* ======== Cache_enable ========
* Enable the cache(s) specified by the 'type' parameter.
*/
Void Cache_enable(Bits16 type)
{
UInt disabled;
/* only enable caches that are currently disabled */
disabled = ~(Cache_getEnabled());
if (disabled & (type & Cache_Type_L1P)) {
Cache_enableL1p(); /* Enable ICache */
}
if (disabled & (type & Cache_Type_L1D)) {
Cache_enableL1d(); /* Enable DCache */
}
}
/*
* ======== Mmu_disable ========
* Function to disable the MMU.
*/
Void Mmu_disable()
{
UInt16 type;
UInt key;
/* if MMU is alreay disabled, just return */
if (!(Mmu_isEnabled())) {
return;
}
key = Hwi_disable();
/* get the current enabled bits */
type = Cache_getEnabled();
if (type & Cache_Type_L1D) {
/* writeback invalidate all data cache */
Cache_wbInvAll();
/* drain the write buffer */
Cache_wait();
/* disable the L1 data cache */
Cache_disable(Cache_Type_L1D);
}
if (type & Cache_Type_L1P) {
/* invalidate all L1 program cache */
Cache_invL1pAll();
/* disable L1P cache */
Cache_disable(Cache_Type_L1P);
}
/* disables the MMU */
Mmu_disableAsm();
/* set cache back to initial settings */
Cache_enable(type);
Hwi_restore(key);
}
