#include"2440addr.h"
void schudel(int i)
{
__asm
(
"push {lr};\
swi 0x00;\
pop {lr};"
:\
:);
}
void swi0()
{
unsigned i,n;
while(1)
{
//rGPBDAT=0x0;
rGPBDAT=~rGPBDAT;
for(i=0;i<=1000;i++)
{
for(n=0;n<=200;n++)
{;}
}
}
}
void swi1()
{
rGPBDAT=0xffffff;
}
void swiint()
{
pswi0=(int)swi0;
pswi1=(int)swi1;
}
/*
* 设置页表
*/
void create_page_table(void)
{
/*
* 用于段描述符的一些宏定义
*/
#define MMU_FULL_ACCESS (3 << 10) /* 访问权限 */
#define ap0 (3<<4)
#define ap1 (3<<6)
#define ap2 (3<<8)
#define ap3 (3<<10)
#define MMU_ap (ap0|ap1|ap2|ap3)
#define MMU_DOMAIN (0 << 5) /* 属于哪个域 */
#define MMU_SPECIAL (1 << 4) /* 必须是1 */
#define MMU_CACHEABLE (1 << 3) /* cacheable */
#define MMU_BUFFERABLE (1 << 2) /* bufferable */
#define MMU_SECTION (2) /* 表示这是段描述符 */
#define MMU_sia (3)
#define MMU_xin (2)
#define MMU_SECDESC (MMU_FULL_ACCESS | MMU_DOMAIN | MMU_SPECIAL | \
MMU_SECTION)
#define MMU_SECDESC_WB (MMU_FULL_ACCESS | MMU_DOMAIN | MMU_SPECIAL | \
MMU_CACHEABLE | MMU_BUFFERABLE | MMU_SECTION)
#define MMU_sia_WB (MMU_DOMAIN | MMU_SPECIAL |MMU_sia)
#define MMU_xin_WB (MMU_ap|MMU_CACHEABLE | MMU_BUFFERABLE|MMU_xin)
#define MMU_SECTION_SIZE 0x00100000
unsigned long virtuladdr, physicaladdr;
unsigned long *mmu_tlb_base = (unsigned long *)0x30000000;
unsigned long *page1=(unsigned long *)0x32000000;
unsigned long *page2=(unsigned long *)0x32001000;
unsigned long *page3=(unsigned long *)0x32002000;
unsigned long *page4=(unsigned long *)0x32003000;
/*
* Steppingstone的起始物理地址为0，第一部分程序的起始运行地址也是0，
* 为了在开启MMU后仍能运行第一部分的程序，
* 将0～1M的虚拟地址映射到同样的物理地址
*/
virtuladdr = 0;
physicaladdr = 0;
*(mmu_tlb_base + (virtuladdr >> 20)) = (physicaladdr & 0xFFF00000) | \
MMU_SECDESC_WB;
/*
* 0x56000000是GPIO寄存器的起始物理地址，
* GPBCON和GPBDAT这两个寄存器的物理地址0x56000010、0x56000014，
* 为了在第二部分程序中能以地址0xA0000010、0xA0000014来操作GPBCON、GPBDAT，
* 把从0xA0000000开始的1M虚拟地址空间映射到从0x56000000开始的1M物理地址空间
*/
virtuladdr = 0x56000000;
physicaladdr = 0x56000000;
*(mmu_tlb_base + (virtuladdr >> 20)) = (physicaladdr & 0xFFF00000) | \
MMU_SECDESC;
/*
* SDRAM的物理地址范围是0x30000000～0x33FFFFFF，
* 将虚拟地址0xB0000000～0xB3FFFFFF映射到物理地址0x30000000～0x33FFFFFF上，
* 总共64M，涉及64个段描述符
*/
virtuladdr = 0x30000000;
*(mmu_tlb_base + (virtuladdr >> 20)) = (0x32000000& 0xFFFFF000) | \
MMU_sia_WB;
virtuladdr = 0x32000000;
*(mmu_tlb_base + (virtuladdr >> 20)) = (0x32001000& 0xFFFFF000) | \
MMU_sia_WB;
virtuladdr = 0x33F00000;
*(mmu_tlb_base + (virtuladdr >> 20)) = (0x32002000& 0xFFFFF000) | \
MMU_sia_WB;
int i=0,n=0;
physicaladdr = 0x30000000;
while(i<1024)
{
for(n=0;n<4;n++)
{
*(page1+i)=(physicaladdr&0xFFFFF000)|MMU_xin_WB;
i++;
}
physicaladdr+=0x1000;
}
physicaladdr = 0x32000000;
i=0;
while(i<1024)
{
for(n=0;n<4;n++)
{
*(page2+i)=(physicaladdr&0xFFFFF000)|MMU_xin_WB;
i++;
}
physicaladdr+=0x1000;
}
physicaladdr = 0x33F00000;
i=0;
while(i<1024)
{
for(n=0;n<4;n++)
{
*(page3+i)=(physicaladdr&0xFFFFF000)|MMU_xin_WB;
i++;
}
physicaladdr+=0x1000;
}
}
/*
* 启动MMU
*/
void mmu_init(void)
{
unsigned long ttb = 0x30000000;
__asm__(
"mov r0, #0\n"
"mcr p15, 0, r0, c7, c7, 0\n" /* 使无效ICaches和DCaches */
"mcr p15, 0, r0, c7, c10, 4\n" /* drain write buffer on v4 */
"mcr p15, 0, r0, c8, c7, 0\n" /* 使无效指令、数据TLB */
"mov r4, %0\n" /* r4 = 页表基址 */
"mcr p15, 0, r4, c2, c0, 0\n" /* 设置页表基址寄存器 */
"mvn r0, #0\n"
"mcr p15, 0, r0, c3, c0, 0\n" /* 域访问控制寄存器设为0xFFFFFFFF，
* 不进行权限检查
*/
/*
* 对于控制寄存器，先读出其值，在这基础上修改感兴趣的位，
* 然后再写入
*/
"mrc p15, 0, r0, c1, c0, 0\n" /* 读出控制寄存器的值 */
/* 控制寄存器的低16位含义为：.RVI ..RS B... .CAM
* R : 表示换出Cache中的条目时使用的算法，
* 0 = Random replacement；1 = Round robin replacement
* V : 表示异常向量表所在的位置，
* 0 = Low addresses = 0x00000000；1 = High addresses = 0xFFFF0000
* I : 0 = 关闭ICaches；1 = 开启ICaches
* R、S : 用来与页表中的描述符一起确定内存的访问权限
* B : 0 = CPU为小字节序；1 = CPU为大字节序
* C : 0 = 关闭DCaches；1 = 开启DCaches
* A : 0 = 数据访问时不进行地址对齐检查；1 = 数据访问时进行地址对齐检查
* M : 0 = 关闭MMU；1 = 开启MMU
*/
/*
* 先清除不需要的位，往下若需要则重新设置它们
*/
/* .RVI ..RS B... .CAM */
"bic r0, r0, #0x3000\n" /* ..11 .... .... .... 清除V、I位 */
"bic r0, r0, #0x0300\n" /* .... ..11 .... .... 清除R、S位 */
"bic r0, r0, #0x0087\n" /* .... .... 1... .111 清除B/C/A/M */
/*
* 设置需要的位
*/
"orr r0, r0, #0x0002\n" /* .... .... .... ..1. 开启对齐检查 */
"orr r0, r0, #0x0004\n" /* .... .... .... .1.. 开启DCaches */
"orr r0, r0, #0x1000\n" /* ...1 .... .... .... 开启ICaches */
"orr r0, r0, #0x0001\n" /* .... .... .... ...1 使能MMU */
"mcr p15, 0, r0, c1, c0, 0\n" /* 将修改的值写入控制寄存器 */
: /* 无输出 */
: "r" (ttb) );
}
void user()
{
__asm__(
"orr r1,r0,#0x10|0xc0\n"
"msr cpsr_cxsf,r1\n" /*USERMode*/
"ldr sp,=0x33ff4800\n" /* userStack=0x33ff_4800*/
);
}
/*
* leds.c: 循环点亮4个LED
* 属于第二部分程序，此时MMU已开启，使用虚拟地址
*/
#define GPB5_out (1<<(5*2))
#define GPB6_out (1<<(6*2))
#define GPB7_out (1<<(7*2))
#define GPB8_out (1<<(8*2))
/*
* wait函数加上“static inline”是有原因的，
* 这样可以使得编译leds.c时，wait嵌入main中，编译结果中只有main一个函数。
* 于是在连接时，main函数的地址就是由连接文件指定的运行时装载地址。
* 而连接文件mmu.lds中，指定了leds.o的运行时装载地址为0xB4004000，
* 这样，head.S中的“ldr pc, =0xB4004000”就是跳去执行main函数。
*/
static inline void wait(unsigned long dly)
{
unsigned int n,i;
for(; dly > 0; dly--)
for(i=0;i<8000;i++);
}
void Timer1_ISR1()
{
rSRCPND = rSRCPND|(0x1<<11);
rINTPND = rINTPND|(0x1<<11);
unsigned int n=0;
unsigned long i = 0;
//rGPBDAT=~rGPBDAT;
schudel(0);
for(i=0;i<=1000;i++)
{
for(n=0;n<=200;n++)
{;}
}
schudel(1);
for(i=0;i<=1000;i++)
{
for(n=0;n<=200;n++)
{;}
}
}
void Isr_Init(void)
{
rINTMOD = 0x0; //All=IRQ mode
rINTMSK = BIT_ALLMSK; //All interrupt is masked.
rINTSUBMSK = BIT_SUB_ALLMSK; //All sub-interrupt is masked. <- April 01, 2002 SOP
}
void Timer1_init(void)
{
rGPGCON = rGPGCON & 0xfff0ffff | 0x00050000; //配置GPG口为信号输出
rGPGDAT = rGPGDAT | 0x300;
rTCFG0 = 255; // Prescaler0=255
rTCFG1 = 0 << 4; //
rTCNTB1 = 48828; // 在pclk=50MHZ下，1秒钟的记数值rTCNTB1 = 50000000 / 4 / 256 = 48828;
rTCMPB1 = 0x00;
rTCON = (1 << 11) | (1 << 9) | (0 << 8); //禁用定时器1，手动加载
rTCON = (1 << 11) | (0 << 9) | (1 << 8); //启动定时器1，自动装载
}
void Timer1INT_Init(void) //定时器接口使能
{
if ((rINTPND & BIT_TIMER1))
{
rSRCPND |= BIT_TIMER1;
}
pISR_TIMER1 = (int) Timer1_ISR1;
rINTMSK &= ~(BIT_TIMER1); //开中断；
}
/*int main(void)
{
unsigned int n,m=0;
unsigned long i = 0;
// 将LED1-4对应的GPB5/6/7/8四个引脚设为输出
rGPBCON= GPB5_out|GPB6_out|GPB7_out|GPB8_out;
rGPBDAT=0x0;
create_page_table();
mmu_init();
swiint();
// user();
while(1)
{
schudel(0);
for(i=0;i<=1000;i++)
{
for(n=0;n<=200;n++)
{;}
}
schudel(1);
for(i=0;i<=1000;i++)
{
for(n=0;n<=200;n++)
{;}
}
}
return 0;
}*/
int main()
{
//MMU_Init();
rGPBCON= GPB5_out|GPB6_out|GPB7_out|GPB8_out;
rGPBDAT=0x0;
create_page_table();
mmu_init();
swiint();
Isr_Init();
Timer1INT_Init();
Timer1_init();
while(1)
{
rGPBDAT=rGPBDAT;
}
return 0;
}
这几个函数分别用都好使，但把create_page_table();mmu_init();加上就不行了，但这两个函数在没用中断时是没有问题的。
我这是在linux下编译生成的，用的是迷你2440；
我还想问问怎么进入用户模式，因为我在打开分页机制下一进入user模式就不行了。帮帮忙。
