forked from Imagelibrary/rtems
45 lines
1.3 KiB
C
45 lines
1.3 KiB
C
/* Blackfin MMU Support
|
|
*
|
|
* Copyright (c) 2008 Kallisti Labs, Los Gatos, CA, USA
|
|
* written by Allan Hessenflow <allanh@kallisti.com>
|
|
*
|
|
* The license and distribution terms for this file may be
|
|
* found in the file LICENSE in this distribution or at
|
|
* http://www.rtems.org/license/LICENSE.
|
|
*/
|
|
|
|
|
|
#include <rtems.h>
|
|
|
|
#include <libcpu/memoryRegs.h>
|
|
#include <libcpu/mmu.h>
|
|
|
|
/* NOTE: see notes in mmu.h */
|
|
|
|
void bfin_mmu_init(bfin_mmu_config_t *config) {
|
|
intptr_t addr;
|
|
intptr_t data;
|
|
int i;
|
|
|
|
addr = (intptr_t) ICPLB_ADDR0;
|
|
data = (intptr_t) ICPLB_DATA0;
|
|
for (i = 0; i < sizeof(config->instruction) / sizeof(config->instruction[0]);
|
|
i++) {
|
|
*(uint32_t volatile *) addr = (uint32_t) config->instruction[i].address;
|
|
addr += ICPLB_ADDR_PITCH;
|
|
*(uint32_t volatile *) data = config->instruction[i].flags;
|
|
data += ICPLB_DATA_PITCH;
|
|
}
|
|
*(uint32_t volatile *) IMEM_CONTROL |= IMEM_CONTROL_ENICPLB;
|
|
addr = (intptr_t) DCPLB_ADDR0;
|
|
data = (intptr_t) DCPLB_DATA0;
|
|
for (i = 0; i < sizeof(config->data) / sizeof(config->data[0]); i++) {
|
|
*(uint32_t volatile *) addr = (uint32_t) config->data[i].address;
|
|
addr += DCPLB_ADDR_PITCH;
|
|
*(uint32_t volatile *) data = config->data[i].flags;
|
|
data += DCPLB_DATA_PITCH;
|
|
}
|
|
*(uint32_t volatile *) DMEM_CONTROL |= DMEM_CONTROL_ENDCPLB;
|
|
}
|
|
|