myinit.s

xscale pxa255 bootloader 程序

	AREA	myinit, CODE, READONLY, ALIGN=5
	EXPORT  SetSpeed	
SetSpeed
	STMFD    r13!,{r1,r14}
	LDR		 r1,=0x190  ;400
	CMP   	 r0,r1
	LDREQ    r0,=0x161  ;set400
	BEQ      setzxit
	LDRNE    r1,=0xc8   ;200
	CMP      r0,r1   
	LDREQ    r0,=0x141  ;set200
	BEQ      setzxit
	LDR      r0,=0x121  ;set100	
setzxit
	LDR      r1,=0x41300000	
	STR		 r0,[r1]
	MOV   	 r0,#0x02
	MCR		 p14,0,r0,c6,c0,0
	MOV		 r0,#0x0
	MCR		 p14,0,r0,c6,c0,0
	MOV      r1,#0x48000000
	LDR      r0,=0x0001c030	
	STR      r0,[r1,#0x04]	
	LDMFD	 r13!,{r1,pc}	
	end