Subversion Repositories freemyipod

Rev

Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
14 theseven 1 
@
2 
@
3 
@    Copyright 2010 TheSeven
4 
@
5 
@
6 
@    This file is part of emBIOS.
7 
@
8 
@    emBIOS is free software: you can redistribute it and/or
9 
@    modify it under the terms of the GNU General Public License as
10 
@    published by the Free Software Foundation, either version 2 of the
11 
@    License, or (at your option) any later version.
12 
@
13 
@    emBIOS is distributed in the hope that it will be useful,
14 
@    but WITHOUT ANY WARRANTY; without even the implied warranty of
15 
@    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
16 
@    See the GNU General Public License for more details.
17 
@
18 
@    You should have received a copy of the GNU General Public License
19 
@    along with emBIOS.  If not, see <http://www.gnu.org/licenses/>.
20 
@
21 
@
22 
 
23 
 
24 
.section .icode.contextswitch, "ax", %progbits
25 
.align 2
26 
.global context_switch
27 
.type context_switch, %function
28 
context_switch:
15 theseven 29 
	mrs	r1, cpsr
43 theseven 30 
	msr	cpsr_c, #0xdf
14 theseven 31 
	ldr	r0, =current_thread
32 
	ldr	r0, [r0]
33 
	stmia	r0!, {r0-r14}
34 
	str	lr, [r0], #4
35 
	str	r1, [r0]
15 theseven 36 
	msr	cpsr_c, #0xd2
14 theseven 37 
	adr	lr, resume_thread
15 theseven 38 
	mov	r0, #-1
14 theseven 39 
	b	scheduler_switch
40 
.size context_switch, .-context_switch
41 
 
43 theseven 42 
.global syscall_handler
43 
.type syscall_handler, %function
44 
syscall_handler:
45 
	ldr	sp, [lr,#-4]
46 
	bics	sp, sp, #0xff000000
47 
	beq	syscall_breakpoint
48 
	mov	r12, lr
49 
	mrs	sp, spsr
50 
	msr	cpsr_c, sp
51 
	mov	lr, r12
52 
	ldr	r12, [lr,#-4]
53 
	bic	r12, r12, #0xff000000
54 
	cmp	r12, #(swilist_end-swilist_start)/4+1
55 
	movcs	r0, #0
56 
	addcc	pc, pc, r12,lsl#2
57 
	adr	r1, unknown_swi_string
58 
	mov	r2, r12
59 
swilist_start:
60 
	b	panicf
61 
	b	get_syscall_table
147 theseven 62 
	b	__clzsi2
63 
	b	__aeabi_uidivmod
64 
	b	__aeabi_idivmod
43 theseven 65 
swilist_end:
66 
 
67 
syscall_breakpoint:
68 
	msr	cpsr_c, #0xd3
69 
	ldr	sp, =current_thread
70 
	ldr	sp, [sp]
71 
	stmia	sp!, {r0-r12}
72 
	mov	r2, lr
73 
	mrs	r3, spsr
74 
	mov	r4, #1
75 
	mov	r5, sp
76 
	msr	cpsr_c, #0xdf
77 
	mov	r0, sp
78 
	mov	r1, lr
79 
	msr	cpsr_c, #0xd2
80 
	stmia	r5, {r0-r4}
81 
	adr	lr, resume_thread
82 
	mov	r0, #-1
83 
	b	scheduler_switch
84 
.size syscall_handler, .-syscall_handler
85 
 
14 theseven 86 
.global irq_handler
87 
.type irq_handler, %function
43 theseven 88 
was_in_svc_mode:
89 
	msr	cpsr_c, #0xd3
90 
	sub	r3, lr, #4
91 
	mrs	r4, spsr
92 
	msr	cpsr_c, r5
93 
	b enter_irqhandler
94 
 
14 theseven 95 
irq_handler:
96 
	str	r12, [sp,#-4]
97 
	ldr	r12, =current_thread
98 
	ldr	r12, [r12]
99 
	stmia	r12!, {r0-r11}
100 
	ldr	r0, [sp,#-4]
101 
	mrs	r5, cpsr
102 
	mrs	r4, spsr
43 theseven 103 
	msr	cpsr_c, #0xdf
14 theseven 104 
	mov	r1, sp
105 
	mov	r2, lr
43 theseven 106 
	and	r3, r4, #0x1f
107 
	cmp	r3, #0x13
108 
	beq	was_in_svc_mode
14 theseven 109 
	msr	cpsr_c, r5
110 
	sub	r3, lr, #4
43 theseven 111 
enter_irqhandler:
14 theseven 112 
	stmia	r12, {r0-r4}
113 
	bl	irqhandler
114 
@ fallthrough
115 
 
116 
.global resume_thread
117 
.type resume_thread, %function
118 
resume_thread:
15 theseven 119 
	ldr	lr, =current_thread
120 
	ldr	lr, [lr]
121 
	mov	r0, lr
122 
	ldr	r1, [lr,#0x40]
123 
	ldr	lr, [lr,#0x3c]
124 
	msr	spsr_all, r1
43 theseven 125 
	msr	cpsr_c, 0xdf
15 theseven 126 
	ldmia	r0, {r0-r14}
14 theseven 127 
	msr	cpsr_c, #0xd2
128 
	movs	pc, lr
129 
.size irq_handler, .-irq_handler
130 
.size resume_thread, .-resume_thread
131 
 
132 
.global enter_critical_section
133 
.type enter_critical_section, %function
134 
enter_critical_section:
135 
	mrs	r0, cpsr
15 theseven 136 
	orr	r1, r0, #0xc0
137 
	msr	cpsr_c, r1
14 theseven 138 
	mov	pc, lr
139 
.size enter_critical_section, .-enter_critical_section
140 
 
141 
.global leave_critical_section
142 
.type leave_critical_section, %function
143 
leave_critical_section:
144 
	msr	cpsr_c, r0
145 
	mov	pc, lr
146 
.size leave_critical_section, .-leave_critical_section
43 theseven 147 
 
127 theseven 148 
.global execfirmware
149 
.type execfirmware, %function
150 
execfirmware:
140 theseven 151 
	str	r0, [sp,#-4]!
219 theseven 152 
	bl	interrupt_shutdown
140 theseven 153 
	bl	clean_dcache
154 
	ldr	r1, [sp], #4
127 theseven 155 
	msr	cpsr_c, #0xd3
140 theseven 156 
	mrc	p15, 0, r0,c1,c0
312 theseven 157 
	bic	r0, r0, #5
140 theseven 158 
	mcr	p15, 0, r0,c1,c0
312 theseven 159 
	mov	r0, #0
140 theseven 160 
	mcr	p15, 0, r0,c7,c5
161 
	bx	r1
127 theseven 162 
.size execfirmware, .-execfirmware
163 
 
43 theseven 164 
unknown_swi_string:
99 theseven 165 
	.ascii "Unhandled SWI %06X\0"