1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
|
/* Copyright (C) 1994, 1997 Free Software Foundation, Inc.
Contributed by Joel Sherrill (jsherril@redstone-emh2.army.mil),
On-Line Applications Research Corporation.
This file is part of the GNU C Library.
The GNU C Library is free software; you can redistribute it and/or
modify it under the terms of the GNU Lesser General Public
License as published by the Free Software Foundation; either
version 2.1 of the License, or (at your option) any later version.
The GNU C Library is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
Lesser General Public License for more details.
You should have received a copy of the GNU Lesser General Public
License along with the GNU C Library; if not, write to the Free
Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
02111-1307 USA. */
/* entry.s
*
* This file contains the entry point for the application.
* The name of this entry point is compiler dependent.
* It jumps to the BSP which is responsible for performing
* all initialization.
*
*/
.data
.global _Do_Load_IDT
.global _Do_Load_GDT
.text
.global start # GNU default entry point
.global _establish_stack
.global _bsp_start
.global _load_segments
.global __exit
start:
nop
cli # DISABLE INTERRUPTS!!!
#
# Load the segment registers
#
# NOTE: Upon return, gs will contain the segment descriptor for
# a segment which maps directly to all of physical memory.
#
jmp _load_segments # load board dependent segments
#
# Set up the stack
#
_establish_stack:
movl $stack_end,%esp # set stack pointer
movl $stack_end,%ebp # set base pointer
#
# Zero out the BSS segment
#
zero_bss:
cld # make direction flag count up
movl $_end,%ecx # find end of .bss
movl $_bss_start,%edi # edi = beginning of .bss
subl %edi,%ecx # ecx = size of .bss in bytes
shrl $2,%ecx # size of .bss in longs
xorl %eax,%eax # value to clear out memory
repne # while ecx != 0
stosl # clear a long in the bss
#
# Set the C heap information for malloc
#
movl $heap_size,___C_heap_size # set ___C_heap_size
movl $heap_memory,___C_heap_start # set ___C_heap_start
#
# Copy the Global Descriptor Table to our space
#
sgdt _Original_GDTR # save original GDT
movzwl _Original_GDTR_limit,%ecx # size of GDT in bytes; limit
# is 8192 entries * 8 bytes per
# make ds:esi point to the original GDT
movl _Original_GDTR_base,%esi
push %ds # save ds
movw %gs,%ax
movw %ax,%ds
# make es:edi point to the new (our copy) GDT
movl $_Global_descriptor_table,%edi
rep
movsb # copy the GDT (ds:esi -> es:edi)
pop %ds # restore ds
# Build and load new contents of GDTR
movw _Original_GDTR_limit,%ecx # set new limit
movw %cx,_New_GDTR_limit
push $_Global_descriptor_table
push %es
call _Logical_to_physical
addl $6,%esp
movl %eax,_New_GDTR_base # set new base
cmpb $0,_Do_Load_GDT # Should the new GDT be loaded?
je no_gdt_load # NO, then branch
lgdt _New_GDTR # load the new GDT
no_gdt_load:
#
# Copy the Interrupt Descriptor Table to our space
#
sidt _Original_IDTR # save original IDT
movzwl _Original_IDTR_limit,%ecx # size of IDT in bytes; limit
# is 256 entries * 8 bytes per
# make ds:esi point to the original IDT
movl _Original_IDTR_base,%esi
push %ds # save ds
movw %gs,%ax
movw %ax,%ds
# make es:edi point to the new (our copy) IDT
movl $_Interrupt_descriptor_table,%edi
rep
movsb # copy the IDT (ds:esi -> es:edi)
pop %ds # restore ds
# Build and load new contents of IDTR
movw _Original_IDTR_limit,%ecx # set new limit
movw %cx,_New_IDTR_limit
push $_Interrupt_descriptor_table
push %es
call _Logical_to_physical
addl $6,%esp
movl %eax,_New_IDTR_base # set new base
cmpb $0,_Do_Load_IDT # Should the new IDT be loaded?
je no_idt_load # NO, then branch
lidt _New_IDTR # load the new IDT
no_idt_load:
#
# Initialize the i387.
#
# Using the NO WAIT form of the instruction insures that if
# it is not present the board will not lock up or get an
# exception.
#
fninit # MUST USE NO-WAIT FORM
call __Board_Initialize # initialize the board
pushl $0 # envp = NULL
pushl $0 # argv = NULL
pushl $0 # argc = NULL
call ___libc_init # initialize the library and
# call main
addl $12,%esp
pushl $0 # argc = NULL
call __exit # call the Board specific exit
addl $4,%esp
#
# Clean up
#
.global _Bsp_cleanup
.global _return_to_monitor
_Bsp_cleanup:
cmpb $0,_Do_Load_IDT # Was the new IDT loaded?
je no_idt_restore # NO, then branch
lidt _Original_IDTR # restore the new IDT
no_idt_restore:
cmpb $0,_Do_Load_GDT # Was the new GDT loaded?
je no_gdt_restore # NO, then branch
lgdt _Original_GDTR # restore the new GDT
no_gdt_restore:
jmp _return_to_monitor
#
# void *Logical_to_physical(
# rtems_unsigned16 segment,
# void *address
# );
#
# Returns thirty-two bit physical address for segment:address.
#
.global _Logical_to_physical
.set SEGMENT_ARG, 4
.set ADDRESS_ARG, 8
_Logical_to_physical:
xorl %eax,%eax # clear eax
movzwl SEGMENT_ARG(%esp),%ecx # ecx = segment value
movl $_Global_descriptor_table,%edx # edx = address of our GDT
addl %ecx,%edx # edx = address of desired entry
movb 7(%edx),%ah # ah = base 31:24
movb 4(%edx),%al # al = base 23:16
shll $16,%eax # move ax into correct bits
movw 2(%edx),%ax # ax = base 0:15
movl ADDRESS_ARG(%esp),%ecx # ecx = address to convert
addl %eax,%ecx # ecx = physical address equivalent
movl %ecx,%eax # eax = ecx
ret
#
# void *Physical_to_logical(
# rtems_unsigned16 segment,
# void *address
# );
#
# Returns thirty-two bit physical address for segment:address.
#
.global _Physical_to_logical
#.set SEGMENT_ARG, 4
#.set ADDRESS_ARG, 8 -- use sets from above
_Physical_to_logical:
xorl %eax,%eax # clear eax
movzwl SEGMENT_ARG(%esp),%ecx # ecx = segment value
movl $_Global_descriptor_table,%edx # edx = address of our GDT
addl %ecx,%edx # edx = address of desired entry
movb 7(%edx),%ah # ah = base 31:24
movb 4(%edx),%al # al = base 23:16
shll $16,%eax # move ax into correct bits
movw 2(%edx),%ax # ax = base 0:15
movl ADDRESS_ARG(%esp),%ecx # ecx = address to convert
subl %eax,%ecx # ecx = logical address equivalent
movl %ecx,%eax # eax = ecx
ret
/*
* Data Declarations. Start with a macro which helps declare space.
*/
.bss
#define DECLARE_SPACE(_name,_space,_align) \
.globl _name ; \
.align _align ; \
_name##: .space _space
#define DECLARE_LABEL(_name) \
.globl _name ; \
_name##:
#define DECLARE_PTR(_name) DECLARE_SPACE(_name,4,2)
#define DECLARE_U32(_name) DECLARE_SPACE(_name,4,2)
#define DECLARE_U16(_name) DECLARE_SPACE(_name,2,1)
/*
* Require environment stuff
*/
DECLARE_LABEL(_environ)
DECLARE_PTR(environ)
DECLARE_LABEL(_errno)
DECLARE_U32(errno)
/*
* Miscellaneous Variables used to restore the CPU state.
*
* Start with a macro to declare the space for the contents of
* a Descriptor Table register.
*/
#define DECLARE_DTR_SPACE(_name) \
.global _name ; \
.align 4 ; \
_name##: ; \
_name##_limit: .space 2 ; \
_name##_base: .space 4
DECLARE_SPACE(_Interrupt_descriptor_table,256*8,4)
DECLARE_SPACE(_Global_descriptor_table,8192*8,4)
DECLARE_DTR_SPACE(_Original_IDTR)
DECLARE_DTR_SPACE(_New_IDTR)
DECLARE_DTR_SPACE(_Original_GDTR)
DECLARE_DTR_SPACE(_New_GDTR)
DECLARE_SPACE(_Physical_base_of_ds,4,4)
DECLARE_SPACE(_Physical_base_of_cs,4,4)
/*
* Stack Size and Space
*/
.set stack_size, 0x20000
DECLARE_SPACE(stack_memory,stack_size,4)
DECLARE_LABEL(stack_end)
|