程序主要是JZ2440的，只是改了一下led.c,下載后發現led閃得非常快.

head.S

@*************************************************************************

@ File：head.S

@ 功能：設置SDRAM，將第二部分代碼復制到SDRAM，設置頁表，啟動MMU，

@       然后跳到SDRAM繼續執行

@*************************************************************************       

.text

.global _start

_start:

    ldr sp, =4096                       @ 設置棧指針，以下都是C函數，調用前需要設好棧

    bl  disable_watch_dog               @ 關閉WATCHDOG，否則CPU會不斷重啟

    bl  memsetup                        @ 設置存儲控制器以使用SDRAM

    bl  copy_2th_to_sdram               @ 將第二部分代碼復制到SDRAM

    bl  create_page_table               @ 設置頁表

    bl  mmu_init                        @ 啟動MMU

    ldr sp, =0xB4000000                 @ 重設棧指針，指向SDRAM頂端(使用虛擬地址)

    ldr pc, =0xB0004000                 @ 跳到SDRAM中繼續執行第二部分代碼

halt_loop:

    b   halt_loop

init.c

/*

 * init.c: 進行一些初始化，在Steppingstone中運行

 * 它和head.S同屬第一部分程序，此時MMU未開啟，使用物理地址

 */ 

/* WATCHDOG寄存器 */

#define WTCON           (*(volatile unsigned long *)0x53000000)

/* 存儲控制器的寄存器起始地址 */

#define MEM_CTL_BASE    0x48000000

/*

 * 關閉WATCHDOG，否則CPU會不斷重啟

 */

void disable_watch_dog(void)

{

    WTCON = 0;  // 關閉WATCHDOG很簡單，往這個寄存器寫0即可

}

/*

 * 設置存儲控制器以使用SDRAM

 */

void memsetup(void)

{

    /* SDRAM 13個寄存器的值 */

    unsigned long  const    mem_cfg_val[]={ 0x22011110,     //BWSCON

                                            0x00000700,     //BANKCON0

                                            0x00000700,     //BANKCON1

                                            0x00000700,     //BANKCON2

                                            0x00000700,     //BANKCON3  

                                            0x00000700,     //BANKCON4

                                            0x00000700,     //BANKCON5

                                            0x00018005,     //BANKCON6

                                            0x00018005,     //BANKCON7

                                            0x008C07A3,     //REFRESH

                                            0x000000B1,     //BANKSIZE

                                            0x00000030,     //MRSRB6

                                            0x00000030,     //MRSRB7

                                    };

    int     i = 0;

    volatile unsigned long *p = (volatile unsigned long *)MEM_CTL_BASE;

    for(; i < 13; i++)

        p[i] = mem_cfg_val[i];

}

/*

 * 將第二部分代碼復制到SDRAM

 */

void copy_2th_to_sdram(void)

{

    unsigned int *pdwSrc  = (unsigned int *)2048;

    unsigned int *pdwDest = (unsigned int *)0x30004000;

    while (pdwSrc < (unsigned int *)4096)//pdwSrc表示地址值

    {

        *pdwDest = *pdwSrc;

        pdwDest++;

        pdwSrc++;

    }

}

/*

 * 設置頁表

 */

void create_page_table(void)

{

/* 

 * 用于段描述符的一些宏定義

 */ 

#define MMU_FULL_ACCESS     (3 << 10)   /* 訪問權限 */

#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_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_SECTION_SIZE    0x00100000

    unsigned long virtuladdr, physicaladdr;

    unsigned long *mmu_tlb_base = (unsigned long *)0x30000000;

    /*

     * Steppingstone的起始物理地址為0，第一部分程序的起始運行地址也是0，

     * 為了在開啟MMU后仍能運行第一部分的程序，

     * 將0～1M的虛擬地址映射到同樣的物理地址

     */

    virtuladdr = 0;

    physicaladdr = 0;

    *(mmu_tlb_base + (virtuladdr >> 20)) = (physicaladdr & 0xFFF00000) |   //一共三個其實是在建表

                                            MMU_SECDESC_WB;

    /*

     * 0x56000000是GPIO寄存器的起始物理地址，

     * GPBCON和GPBDAT這兩個寄存器的物理地址0x56000050、0x56000054，

     * 為了在第二部分程序中能以地址0xA0000050、0xA0000054來操作GPFCON、GPFDAT，

     * 把從0xA0000000開始的1M虛擬地址空間映射到從0x56000000開始的1M物理地址空間

     */

    virtuladdr = 0xA0000000;

    physicaladdr = 0x56000000;

    *(mmu_tlb_base + (virtuladdr >> 20)) = (physicaladdr & 0xFFF00000) |

                                            MMU_SECDESC;

    /*

     * SDRAM的物理地址范圍是0x30000000～0x33FFFFFF，

     * 將虛擬地址0xB0000000～0xB3FFFFFF映射到物理地址0x30000000～0x33FFFFFF上，

     * 總共64M，涉及64個段描述符

     */

    virtuladdr = 0xB0000000;

    physicaladdr = 0x30000000;

    while (virtuladdr < 0xB4000000)

    {

        *(mmu_tlb_base + (virtuladdr >> 20)) = (physicaladdr & 0xFFF00000) |

                                                MMU_SECDESC_WB;

        virtuladdr += 0x100000;

        physicaladdr += 0x100000;

    }

}

/*

 * 啟動MMU

 */

void mmu_init(void)

{

    unsigned long ttb = 0x30000000;

__asm__(

    "mov    r0, #0n"

    "mcr    p15, 0, r0, c7, c7, 0n"    /* 使無效ICaches和DCaches */

    "mcr    p15, 0, r0, c7, c10, 4n"   /* drain write buffer on v4 */

    "mcr    p15, 0, r0, c8, c7, 0n"    /* 使無效指令、數據TLB */

    "mov    r4, %0n"                   /* r4 = 頁表基址 */

    "mcr    p15, 0, r4, c2, c0, 0n"    /* 設置頁表基址寄存器 */

    "mvn    r0, #0n"                   

    "mcr    p15, 0, r0, c3, c0, 0n"    /* 域訪問控制寄存器設為0xFFFFFFFF，

                                         * 不進行權限檢查 

                                         */    

    /* 

     * 對于控制寄存器，先讀出其值，在這基礎上修改感興趣的位，

     * 然后再寫入

     */

    "mrc    p15, 0, r0, c1, c0, 0n"    /* 讀出控制寄存器的值 */

    /* 控制寄存器的低16位含義為：.RVI ..RS B... .CAM

     * R : 表示換出Cache中的條目時使用的算法，

     *     0 = Random replacement；1 = Round robin replacement