1 |
27 |
unneback |
##=============================================================================
|
2 |
|
|
##
|
3 |
|
|
## context.S
|
4 |
|
|
##
|
5 |
|
|
## mcf52xx context switch code
|
6 |
|
|
##
|
7 |
|
|
##=============================================================================
|
8 |
|
|
#####ECOSGPLCOPYRIGHTBEGIN####
|
9 |
|
|
## -------------------------------------------
|
10 |
|
|
## This file is part of eCos, the Embedded Configurable Operating System.
|
11 |
|
|
## Copyright (C) 1998, 1999, 2000, 2001, 2002 Red Hat, Inc.
|
12 |
|
|
##
|
13 |
|
|
## eCos is free software; you can redistribute it and/or modify it under
|
14 |
|
|
## the terms of the GNU General Public License as published by the Free
|
15 |
|
|
## Software Foundation; either version 2 or (at your option) any later version.
|
16 |
|
|
##
|
17 |
|
|
## eCos is distributed in the hope that it will be useful, but WITHOUT ANY
|
18 |
|
|
## WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
19 |
|
|
## FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
20 |
|
|
## for more details.
|
21 |
|
|
##
|
22 |
|
|
## You should have received a copy of the GNU General Public License along
|
23 |
|
|
## with eCos; if not, write to the Free Software Foundation, Inc.,
|
24 |
|
|
## 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
|
25 |
|
|
##
|
26 |
|
|
## As a special exception, if other files instantiate templates or use macros
|
27 |
|
|
## or inline functions from this file, or you compile this file and link it
|
28 |
|
|
## with other works to produce a work based on this file, this file does not
|
29 |
|
|
## by itself cause the resulting work to be covered by the GNU General Public
|
30 |
|
|
## License. However the source code for this file must still be made available
|
31 |
|
|
## in accordance with section (3) of the GNU General Public License.
|
32 |
|
|
##
|
33 |
|
|
## This exception does not invalidate any other reasons why a work based on
|
34 |
|
|
## this file might be covered by the GNU General Public License.
|
35 |
|
|
##
|
36 |
|
|
## Alternative licenses for eCos may be arranged by contacting Red Hat, Inc.
|
37 |
|
|
## at http://sources.redhat.com/ecos/ecos-license/
|
38 |
|
|
## -------------------------------------------
|
39 |
|
|
#####ECOSGPLCOPYRIGHTEND####
|
40 |
|
|
##=============================================================================
|
41 |
|
|
|
42 |
|
|
#include
|
43 |
|
|
|
44 |
|
|
#------------------------------------------------------------------------------
|
45 |
|
|
# function declaration macro
|
46 |
|
|
|
47 |
|
|
#define FUNC_START(name) \
|
48 |
|
|
.text; \
|
49 |
|
|
.even; \
|
50 |
|
|
.globl name; \
|
51 |
|
|
name:
|
52 |
|
|
|
53 |
|
|
#------------------------------------------------------------------------------
|
54 |
|
|
# hal_thread_switch_context
|
55 |
|
|
# Switch thread contexts
|
56 |
|
|
# : 0(%sp) : return address
|
57 |
|
|
# : 4(%sp) : to - address of sp of next thread to execute
|
58 |
|
|
# : 8(%sp) : from - address of sp save location of current thread
|
59 |
|
|
#
|
60 |
|
|
# d0, d1, a0, a1 are ours to abuse.
|
61 |
|
|
#
|
62 |
|
|
# externC void hal_thread_switch_context( CYG_ADDRESS to, CYG_ADDRESS from );
|
63 |
|
|
|
64 |
|
|
FUNC_START(hal_thread_switch_context)
|
65 |
|
|
|
66 |
|
|
move.l 4(%sp),%a0 /* Read the to and from from */
|
67 |
|
|
move.l 8(%sp),%a1 /* parameters from the stack. */
|
68 |
|
|
|
69 |
|
|
lea -(6+5)*4(%sp),%sp /* Save all of the registers */
|
70 |
|
|
movem.l %d2-%d7/%a2-%a6,(%sp) /* that the C calling */
|
71 |
|
|
/* convention expects us to */
|
72 |
|
|
/* preserve. */
|
73 |
|
|
|
74 |
|
|
move.l %sp,(%a1) /* Store this threads current */
|
75 |
|
|
/* stack pointer to *from. */
|
76 |
|
|
|
77 |
|
|
move.l (%a0),%sp /* Load the stack pointer for */
|
78 |
|
|
/* the next thread from *to. */
|
79 |
|
|
|
80 |
|
|
movem.l (%sp),%d2-%d7/%a2-%a6 /* Load all of the preserved */
|
81 |
|
|
lea (6+5)*4(%sp),%sp /* registers from the stack. */
|
82 |
|
|
|
83 |
|
|
rts /* Restore the PC. */
|
84 |
|
|
|
85 |
|
|
#------------------------------------------------------------------------------
|
86 |
|
|
# hal_thread_load_context
|
87 |
|
|
# Load thread context
|
88 |
|
|
# : 4(%sp) : to - address of sp of next thread to execute
|
89 |
|
|
#
|
90 |
|
|
# d0, d1, a0, a1 are ours to abuse.
|
91 |
|
|
|
92 |
|
|
FUNC_START(hal_thread_load_context)
|
93 |
|
|
|
94 |
|
|
move.l 4(%sp),%a0 /* Read the to parameter from */
|
95 |
|
|
move.l (%a0),%sp /* the stack and switch to that */
|
96 |
|
|
/* stack pointer. */
|
97 |
|
|
|
98 |
|
|
movem.l (%sp),%d2-%d7/%a2-%a6 /* Load all of the preserved */
|
99 |
|
|
lea (6+5)*4(%sp),%sp /* registers from the stack. */
|
100 |
|
|
|
101 |
|
|
rts /* Restore the PC. */
|
102 |
|
|
|
103 |
|
|
##=============================================================================
|
104 |
|
|
##=============================================================================
|
105 |
|
|
|