blob: 8451cfde73160704789dd3b6db3d1d7d4ba9eb27 (
plain)
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
|
\ *****************************************************************************
\ * Copyright (c) 2004, 2008 IBM Corporation
\ * All rights reserved.
\ * This program and the accompanying materials
\ * are made available under the terms of the BSD License
\ * which accompanies this distribution, and is available at
\ * http://www.opensource.org/licenses/bsd-license.php
\ *
\ * Contributors:
\ * IBM Corporation - initial implementation
\ ****************************************************************************/
\ (rtas-size) determines the size required for RTAS.
\ It looks at the rtas binary in the flash and reads the rtas-size from
\ its header at offset 8.
: (rtas-size) ( -- rtas-size )
s" rtas" romfs-lookup dup 0=
ABORT" romfs-lookup for rtas failed"
drop 8 + @
;
(rtas-size) CONSTANT rtas-size
: instantiate-rtas ( adr -- entry )
dup rtas-size erase
s" rtas" romfs-lookup 0=
ABORT" romfs-lookup for rtas failed"
rtas-config swap start-rtas ;
here fff + fffffffffffff000 and here - allot
here rtas-size allot CONSTANT rtas-start-addr
rtas-start-addr instantiate-rtas CONSTANT rtas-entry-point
: drone-rtas
rtas-start-addr
dup rtas-size erase
2000000 start-rtas to rtas-entry-point
;
\ ffffffffffffffff CONSTANT rtas-entry-point
\ rtas control block
STRUCT
/l field rtas>token
/l field rtas>nargs
/l field rtas>nret
/l field rtas>args0
/l field rtas>args1
/l field rtas>args2
/l field rtas>args3
/l field rtas>args4
/l field rtas>args5
/l field rtas>args6
/l field rtas>args7
/l C * field rtas>args
/l field rtas>bla
CONSTANT /rtas-control-block
CREATE rtas-cb /rtas-control-block allot
rtas-cb /rtas-control-block erase
\ call-c ( p0 p1 p2 entry -- ret )
: enter-rtas ( -- )
rtas-cb rtas-start-addr 0 rtas-entry-point call-c drop ;
\ This is the structure of the RTAS function jump table in the C code:
STRUCT
cell FIELD rtasfunctab>name
cell FIELD rtasfunctab>func
cell FIELD rtasfunctab>flags
CONSTANT rtasfunctab-size
\ Create RTAS token properties by analyzing the jump table in the C code:
: rtas-create-token-properties ( -- )
rtas-start-addr 10 + @ rtas-start-addr + \ Get pointer to jump table
rtas-start-addr 18 + @ rtas-start-addr + l@ \ Get the number of entries
0 DO
dup rtasfunctab>func @ 0<> \ function pointer must not be NULL
over rtasfunctab>flags @ 1 and 0= \ Check the only-internal flag
and
IF
i 1+ encode-int \ Create the token value
2 pick rtasfunctab>name @ zcount \ Create the token name string
property \ Create the property
THEN
rtasfunctab-size + \ Proceed to the next entry
LOOP
drop
;
\ Get the RTAS token that corresponds to an RTAS property name:
: rtas-get-token ( str len -- token|0 )
rtas-start-addr 10 + @ rtas-start-addr + \ Get pointer to jump table
rtas-start-addr 18 + @ rtas-start-addr + l@ \ Get the number of entries
0 DO
dup rtasfunctab>name @ \ Get pointer to function name
dup 0<> \ function name must not be NULL
over zcount 5 pick = nip and \ Check if both strings have same length
IF
3 pick 3 pick \ Make a copy of the token name string
comp 0=
IF
drop 2drop
i 1+ \ If the name matched, return the token
UNLOOP EXIT
THEN
ELSE
drop
THEN
rtasfunctab-size + \ Proceed to the next entry
LOOP
drop
." RTAS token not found: " type cr
0
;
|
