ARM启动代码分析－philips的LPC2xxx系列
/**********************************************************************************************
*File: startup.s
*Author: Embest w.h.xie 2005.02.21
*Desc: lpc22xxlpc212xlpc211xlpc210x startup code
*History:
* note modify： cui jian jie 2006-4-25
*comment:
**********************************************************************************************/
# 处理器的七种工作方式的常量定义
.EQU Mode_USR, 0x10 #用户模式
.EQU Mode_FIQ, 0x11 #FIQ模式
.EQU Mode_IRQ, 0x12 #IRQ模式
.EQU Mode_SVC, 0x13 #超级用户模式
.EQU Mode_ABT, 0x17 #终止模式
.EQU Mode_UND, 0x1B #未定义模式
.EQU Mode_SYS, 0x1F #系统模式
# 中断屏蔽位
.EQU I_Bit, 0x80 //IRQ中断控制位，当被置位时，IRQ中断被禁止
.EQU F_Bit, 0x40 //FIQ中断控制位，当被置位时，FIQ中断被禁止
# 状态屏蔽位
.EQU T_bit, 0x20 //T位，置位时在Thumb模式下运行，清零时在ARM下运行
# 定义程序入口点
.globl _start
.code 32
.TEXT
_start:
# 中断向量表
Vectors:
LDR PC, Reset_Addr //把Reset_Addr地址处的内容放入PC中
LDR PC, Undef_Addr
LDR PC, SWI_Addr
LDR PC, PAbt_Addr
LDR PC, DAbt_Addr
.long 0xb9205f80 @ keep interrupt vectors sum is 0
LDR PC, [PC, #-0xff0] //当前PC值减去0xFF0等于IRQ中断入口地址
LDR PC, FIQ_Addr
#地址表
Reset_Addr: #该地址标号存放Reset_Handler程序段的入口地址
.long Reset_Handler
Undef_Addr: #该地址标号存放Undef_Handler程序段的入口地址
.long Undef_Handler
SWI_Addr: #该地址标号存放SWI_Handler程序段的入口地址
.long SWI_Handler
PAbt_Addr: #该地址标号存放PAbt_Handler程序段的入口地址
.long PAbt_Handler
DAbt_Addr:
.long DAbt_Handler
.long 0
IRQ_Addr: #地址标号处存放一个无效的数据
.long 0
FIQ_Addr: #该地址标号存放FIQ_Handler程序段的入口地址
.long FIQ_Handler
Undef_Handler:
B Undef_Handler
PAbt_Handler:
B PAbt_Handler
DAbt_Handler:
B DAbt_Handler
#软中断的中断服务子程序入口地址
SWI_Handler:
STMFD sp!, {r0-r3, r12, lr} //入栈，现场数据保护
MOV r1, sp //把堆栈指针SP存入R1中
MRS r0, spsr //把SPSR值存入R0，SPSR值为产生软中断时的CPSR
TST r0, #T_bit //判断R0（SPSR）的T位是否为0
#SPSR的T位不为0，工作在Thumb模式下
LDRNEH r0, [lr,#-2] //SPSR的T位不为0，则[lr-2]-〉r0
BICNE r0, r0, #0xFF00 // SPSR的T位不为0，清除r0的Bit8~Bit15位
# SPSR的T位为0，工作在ARM模式下
LDREQ r0, [lr,#-4] // SPSR的T位为0，则[lr-4] -〉r0
BICEQ r0, r0, #0xFF000000 // SPSR的T位为0，清除r0的Bit24~Bit131位
# R0 is interrupt number //R0是中断号
# R1 is stack point //R1是堆栈指针
BL SWI_Exception //进入软中断处理程序
LDMFD sp!, {r0-r3, r12, pc}^ //出栈，现场数据恢复
# 快速响应中断的中断服务自程序的入口地址
FIQ_Handler:
STMFD SP!, {R0-R3, LR} //入栈的现场保护
# BL FIQ_Exception //进入FIQ的中断处理程序
LDMFD SP!, {R0-R3, LR} //出栈，恢复现场
SUBS PC, LR, #4 //返回到主程序
# 复位后程序处理的入口地址
Reset_Handler:
BL RemapSRAM //进行存储器映射的操作
#下面几行代码用来判断当前的工作模式
MRS R0, CPSR //读CPSR到寄存器R0
AND R0, R0, #0x1F //R0 = R0 AND 0x1F
CMP R0, #Mode_USR //比较R0 和 #Mode_USR，二者相减
//如果相等则说明当前处在用户模式下，需要通过产生11号软中断进入系统模式。因为下面的初始化堆栈
//需要在不同的工作模式下切换，而在用户模式下不能直接切换，只有系统模式可以，所以要通过产生11
//号软中断切换到用户模式。
SWIEQ #11
BL InitStack //进行堆栈初始化工作
ARM启动代码分析－philips的LPC2xxx系列32006-7-24 14:33:00
#------------------------------------------------------------------------------
#- 初始化C变量
#------------------------
#- 下表由连接器自动产生
#- RO: 只读=代码区。
#- RW: 可读可写=预先初始化的数据(初始化的全局变量)和预先被清零的数据(未初始化的全局变量)。.
#- ZI: 预先被清零的数据区(未初始化的全局变量)
#- 预先被初始化的数据区定位在代码区之后。
#- 预先被清零的数据区定位在预先被初始化的数据区之后。
#- 注意数据区的位置 :
#- I如果用 ARM SDT, 当链接器选择no -rw-base时, 数据区被映射在代码区之后
#- 你可以把数据区房子内部的SRAM( -rw-base=0x40 or 0x34)中
#- 或者放在外部的SRAM( -rw-base=0x2000000 )中。
#- 注意：为了提高代码的密度，预先被初始化的数据必须尽可能的少。
#------------------------------------------------------------------------------
#该部分程序功能：先判断当前是在RAM中运行还是在FLASH中运行，如果在FLASH中运行，先把FLASH
#中的预先赋值的RW段数据和未赋值的ZI段数据都搬移到RAM区中，再把ZI段数据全部清零；如果程#序就是在RAM中运行，则直接把ZI段数据清零。
.extern Image_RO_Limit /* ROM区中数据段的起始地址*/
.extern Image_RW_Base /* RW段起始地址 */
.extern Image_ZI_Base /* ZI段的起始地址*/
.extern Image_ZI_Limit /* ZI段的结束地址加1 */
ldr r0, =Image_RO_Limit /* 取ROM区中数据段的首地址 */
ldr r1, =Image_RW_Base /* 取RAM区中RW段的目标首地址*/
ldr r3, =Image_ZI_Base /*取RAM区中ZI段的首地址 */
cmp r0, r1 /* 比较ROM区中数据段首地址和RAM区中RW段目标首地址 */
beq NoRW /*相等代表当前是在RAM中运行*/
LoopRw: cmp r1, r3 /*不相等则和RAM区中ZI段的目标地址比较*/
ldrcc r2, [r0], #4 /*如果r1<r3，则把r0地址上的数据读出到r2中，然后r0=r0+4*/
strcc r2, [r1], #4 /*如果r1<r3，则把r2内数据写入道r1地址中，然后r1=r1+4*/
bcc LoopRw /*如果r1<r3，则跳转到LoopRw 继续执行*/
NoRW: ldr r1, =Image_ZI_Limit /* 取ZI段的结束地址 */
mov r2, #0 /*将r2赋0*/
LoopZI: cmp r3, r1 /* 将ZI段清零*/
strcc r2, [r3], #4 /*如果r3<r1，将r2内容写入到r3地址单元中，然后r3=r3+1*/
bcc LoopZI /*如果r3<r1(即C=0)，则跳转到LoopZI */
.extern Main /*声明外部变量*/
B Main /*t跳转到用户的主程序入口*/
# 为每一种模式建立堆栈，ARM堆栈指针向下生长
InitStack:
MOV R1, LR //把该子程序返回地址保留在R1中
LDR R0, =Top_Stack //取栈定地址到R0中
#进入未定义模式，并禁止FIQ中断和IRQ中断
MSR CPSR_c, #Mode_UND|I_Bit|F_Bit
#设置未定义模式下堆栈的栈顶指针
MOV SP, R0
SUB R0, R0, #UND_Stack_Size #未定义模式下堆栈深度
#进入终止模式，并禁止禁止FIQ中断和IRQ中断
MSR CPSR_c, #Mode_ABT|I_Bit|F_Bit
#紧接着未定义模式下的堆栈，设置终止模式下栈顶指针
MOV SP, R0
SUB R0, R0, #ABT_Stack_Size #终止模式下堆栈深度
#进入FIQ模式，并禁止FIQ中断和IRQ中断
MSR CPSR_c, #Mode_FIQ|I_Bit|F_Bit
#紧接着终止模式下的堆栈，设置下FIQ模式下栈顶指针
MOV SP, R0
SUB R0, R0, #FIQ_Stack_Size #FIQ模式下的堆栈深度
#进入IRQ模式，并禁止FIQ中断和IRQ中断
MSR CPSR_c, #Mode_IRQ|I_Bit|F_Bit
#紧接着FIQ模式下的堆栈，设置IRQ模式下的栈顶指针
MOV SP, R0
SUB R0, R0, #IRQ_Stack_Size #IRQ模式下的堆栈深度
#进入超级用户模式，并禁止FIQ中断和IRQ中断
MSR CPSR_c, #Mode_SVC|I_Bit|F_Bit
#紧接着IRQ模式下的堆栈，设置超级用户下的栈顶指针
MOV SP, R0
SUB R0, R0, #SVC_Stack_Size #超级用户下的堆栈深度
#设置进入用户模式
MSR CPSR_c, #Mode_USR
#紧接着超级用户模式下的堆栈，设置用户模式下的栈顶指针，剩余的空间都开辟为堆栈
MOV SP, R0
MOV PC, R1 #堆栈初始化子程序返回
# 重映射SRAM区
RemapSRAM:
MOV R0, #0x40000000 //RAM区首地址
LDR R1, =Vectors //向量表首地址
#下面一段程序是把从0x00000000开始的64个字节（FLASH中的中断向量表和地址表）搬移到以
#0x40000000为首地址的RAM区中
LDMIA R1!, {R2-R9} //把以[R1]为首地址的32个字节数据装载到R2-R9中
STMIA R0!, {R2-R9} //把R2-R9中的数据存入以[R0]为首地址的单元中
LDMIA R1!, {R2-R9} //把以[R1]为首地址的32个字节数据装载到R2-R9中
STMIA R0!, {R2-R9} ////把R2-R9中的数据存入以[R0]为首地址的单元中
#下面几行代码设置存储器映射控制寄存器
LDR R0, =MEMMAP //取MEMMAP地址到R0
MOV R1, #0x02
STR R1, [R0] //给MEMMAP赋值为0x02，设置中断向量从RAM区从新映射
mov pc, lr //跳转到主程序
#下面一段程序代码是进入软中断来切换系统的工作模式，当希望从一种模式切换入另一种模式时，可以通
#过调用下面对应标号的程序段进入软中断。在软中断处理程序中会根据所给定的中断号处理，执行SWI #num后软中断号被存入R0中。
.globl disable_IRQ
.globl restore_IRQ
.globl ToSys
.globl ToUser
# 禁止IRQ
disable_IRQ:
STMFD SP!, {LR} //把LR值压入堆栈
swi #0 //产生0号软中断， 0 -〉R0
LDMFD SP!, {pc} //恢复PC值，返回
# 恢复IRQ
restore_IRQ:
STMFD SP!, {LR} //把LR值压入堆栈
swi #1 //产生1号软中断，1 –〉R0
LDMFD SP!, {pc} //恢复PC值，返回
#进入系统工作模式
ToSys:
STMFD SP!, {LR} //把LR值压入堆栈
swi #11 //产生11号软中断，11 –〉R0
LDMFD SP!, {pc} //恢复PC值，返回
# 进入用户工作模式
ToUser:
STMFD SP!, {LR} //把LR值压入堆栈
swi #12 //产生12号软中断，11 –〉R0
LDMFD SP!, {pc} //恢复PC值，返回
|
楼主
标题置顶
标题高亮
