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
62 
swilist_end:
63 
 
64 
syscall_breakpoint:
65 
	msr	cpsr_c, #0xd3
66 
	ldr	sp, =current_thread
67 
	ldr	sp, [sp]
68 
	stmia	sp!, {r0-r12}
69 
	mov	r2, lr
70 
	mrs	r3, spsr
71 
	mov	r4, #1
72 
	mov	r5, sp
73 
	msr	cpsr_c, #0xdf
74 
	mov	r0, sp
75 
	mov	r1, lr
76 
	msr	cpsr_c, #0xd2
77 
	stmia	r5, {r0-r4}
78 
	adr	lr, resume_thread
79 
	mov	r0, #-1
80 
	b	scheduler_switch
81 
.size syscall_handler, .-syscall_handler
82 
 
14 theseven 83 
.global irq_handler
84 
.type irq_handler, %function
43 theseven 85 
was_in_svc_mode:
86 
	msr	cpsr_c, #0xd3
87 
	sub	r3, lr, #4
88 
	mrs	r4, spsr
89 
	msr	cpsr_c, r5
90 
	b enter_irqhandler
91 
 
14 theseven 92 
irq_handler:
93 
	str	r12, [sp,#-4]
94 
	ldr	r12, =current_thread
95 
	ldr	r12, [r12]
96 
	stmia	r12!, {r0-r11}
97 
	ldr	r0, [sp,#-4]
98 
	mrs	r5, cpsr
99 
	mrs	r4, spsr
43 theseven 100 
	msr	cpsr_c, #0xdf
14 theseven 101 
	mov	r1, sp
102 
	mov	r2, lr
43 theseven 103 
	and	r3, r4, #0x1f
104 
	cmp	r3, #0x13
105 
	beq	was_in_svc_mode
14 theseven 106 
	msr	cpsr_c, r5
107 
	sub	r3, lr, #4
43 theseven 108 
enter_irqhandler:
14 theseven 109 
	stmia	r12, {r0-r4}
110 
	bl	irqhandler
111 
@ fallthrough
112 
 
113 
.global resume_thread
114 
.type resume_thread, %function
115 
resume_thread:
15 theseven 116 
	ldr	lr, =current_thread
117 
	ldr	lr, [lr]
118 
	mov	r0, lr
119 
	ldr	r1, [lr,#0x40]
120 
	ldr	lr, [lr,#0x3c]
121 
	msr	spsr_all, r1
43 theseven 122 
	msr	cpsr_c, 0xdf
15 theseven 123 
	ldmia	r0, {r0-r14}
14 theseven 124 
	msr	cpsr_c, #0xd2
125 
	movs	pc, lr
126 
.size irq_handler, .-irq_handler
127 
.size resume_thread, .-resume_thread
128 
 
129 
.global enter_critical_section
130 
.type enter_critical_section, %function
131 
enter_critical_section:
132 
	mrs	r0, cpsr
15 theseven 133 
	orr	r1, r0, #0xc0
134 
	msr	cpsr_c, r1
14 theseven 135 
	mov	pc, lr
136 
.size enter_critical_section, .-enter_critical_section
137 
 
138 
.global leave_critical_section
139 
.type leave_critical_section, %function
140 
leave_critical_section:
141 
	msr	cpsr_c, r0
142 
	mov	pc, lr
143 
.size leave_critical_section, .-leave_critical_section
43 theseven 144 
 
127 theseven 145 
.global execfirmware
146 
.type execfirmware, %function
147 
execfirmware:
148 
	msr	cpsr_c, #0xd3
149 
	bx	r0
150 
.size execfirmware, .-execfirmware
151 
 
43 theseven 152 
unknown_swi_string:
99 theseven 153 
	.ascii "Unhandled SWI %06X\0"