blob: 9ca6b78e32cbdcc04d078db8672cd60730269635 (
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
|
\ tag: Useful device related functions
\
\ Copyright (C) 2003, 2004 Samuel Rydh
\
\ See the file "COPYING" for further information about
\ the copyright and warranty status of this work.
\
: parent ( phandle -- parent.phandle|0 )
>dn.parent @
;
\ -------------------------------------------------------------------
\ property helpers
\ -------------------------------------------------------------------
: int-property ( value name-str name-len -- )
rot encode-int 2swap property
;
\ -------------------------------------------------------------------------
\ property utils
\ -------------------------------------------------------------------------
\ like property (except it takes a phandle as an argument)
: encode-property ( buf len propname propname-len phandle -- )
dup 0= abort" null phandle"
my-self >r 0 to my-self
active-package >r active-package!
property
r> active-package!
r> to my-self
;
\ -------------------------------------------------------------------
\ device tree iteration
\ -------------------------------------------------------------------
: iterate-tree ( phandle -- phandle|0 )
?dup 0= if device-tree @ exit then
\ children first
dup child if
child exit
then
\ then peers
dup peer if
peer exit
then
\ then peer of a parent
begin >dn.parent @ dup while
dup peer if peer exit then
repeat
;
: iterate-tree-begin ( -- first_node )
device-tree @
;
\ -------------------------------------------------------------------
\ device tree iteration
\ -------------------------------------------------------------------
: iterate-device-type ( lastph|0 type-str type-len -- 0|nextph )
rot
begin iterate-tree ?dup while
>r
2dup " device_type" r@ get-package-property if 0 0 then
dup 0> if 1- then
strcmp 0= if 2drop r> exit then
r>
repeat
2drop 0
;
\ -------------------------------------------------------------------
\ device tree "cut and paste"
\ -------------------------------------------------------------------
\ add a subtree to the current device node
: link-nodes ( phandle -- )
\ reparent phandle and peers
dup begin ?dup while
dup >dn.parent active-package !
>dn.peer @
repeat
\ add to list of children
active-package >dn.child
begin dup @ while @ >dn.peer repeat dup . !
;
: link-node ( phandle -- )
0 over >dn.peer !
link-nodes
;
|
