Merge from vendor branch LIBPCAP:
[dragonfly.git] / sys / boot / forth / pnp.4th
1 \ Copyright (c) 2000 Daniel C. Sobral <dcs@freebsd.org>
2 \ All rights reserved.
3 \
4 \ Redistribution and use in source and binary forms, with or without
5 \ modification, are permitted provided that the following conditions
6 \ are met:
7 \ 1. Redistributions of source code must retain the above copyright
8 \    notice, this list of conditions and the following disclaimer.
9 \ 2. Redistributions in binary form must reproduce the above copyright
10 \    notice, this list of conditions and the following disclaimer in the
11 \    documentation and/or other materials provided with the distribution.
12 \
13 \ THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
14 \ ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
15 \ IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
16 \ ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
17 \ FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
18 \ DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
19 \ OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
20 \ HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
21 \ LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
22 \ OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
23 \ SUCH DAMAGE.
24 \
25 \ $FreeBSD: src/sys/boot/forth/pnp.4th,v 1.2 2001/12/11 00:49:34 jhb Exp $
26 \ $DragonFly: src/sys/boot/forth/pnp.4th,v 1.1 2003/11/10 06:08:34 dillon Exp $
27
28 pnpdevices drop
29
30 : enumerate
31   pnphandlers begin
32     dup @
33   while
34     ." Probing " dup @ pnph.name @ dup strlen type ." ..." cr
35     0 over @ pnph.enumerate @ ccall drop
36     cell+
37   repeat
38 ;
39
40 : summary
41   ." PNP scan summary:" cr
42   pnpdevices stqh_first @
43   begin
44     dup
45   while
46     dup pnpi.ident stqh_first @ pnpid.ident @ dup strlen type
47     dup pnpi.desc @ ?dup if
48       ."  : "
49       dup strlen type
50     then
51     cr
52     pnpi.link stqe_next @
53   repeat
54   drop
55 ;
56
57 : compare-pnpid ( addr addr' -- flag )
58   begin
59     over c@ over c@ <> if drop drop false exit then
60     over c@ over c@ and
61   while
62     char+ swap char+ swap
63   repeat
64   c@ swap c@ or 0=
65 ;
66
67 : search-pnpid  ( id -- flag )
68   >r
69   pnpdevices stqh_first @
70   begin ( pnpinfo )
71     dup
72   while
73     dup pnpi.ident stqh_first @
74     begin ( pnpinfo pnpident )
75       dup pnpid.ident @ r@ compare-pnpid
76       if
77         r> drop
78         \ XXX Temporary debugging message
79         ." Found " pnpid.ident @ dup strlen type
80         pnpi.desc @ ?dup if
81           ." : " dup strlen type
82         then cr
83         \ drop drop
84         true
85         exit
86       then
87       pnpid.link stqe_next @
88       ?dup 0=
89     until
90     pnpi.link stqe_next @
91   repeat
92   r> drop
93   drop
94   false
95 ;
96
97 : skip-space  ( addr -- addr' )
98   begin
99     dup c@ bl =
100     over c@ 9 = or
101   while
102     char+
103   repeat
104 ;
105
106 : skip-to-space  ( addr -- addr' )
107   begin
108     dup c@ bl <>
109     over c@ 9 <> and
110     over c@ and
111   while
112     char+
113   repeat
114 ;
115
116 : premature-end?  ( addr -- addr flag )
117   postpone dup postpone c@ postpone 0=
118   postpone if postpone exit postpone then
119 ; immediate
120
121 0 value filename
122 0 value timestamp
123 0 value id
124
125 only forth also support-functions
126
127 : (load) load ;
128
129 : check-pnpid  ( -- )
130   line_buffer .addr @ 
131   \ Search for filename
132   skip-space premature-end?
133   dup to filename
134   \ Search for end of filename
135   skip-to-space premature-end?
136   0 over c!  char+
137   \ Search for timestamp
138   skip-space premature-end?
139   dup to timestamp
140   skip-to-space premature-end?
141   0 over c!  char+
142   \ Search for ids
143   begin
144     skip-space premature-end?
145     dup to id
146     skip-to-space dup c@ >r
147     0 over c!  char+
148     id search-pnpid if
149       filename dup strlen 1 ['] (load) catch if
150         drop drop drop
151         ." Error loading " filename dup strlen type cr
152       then
153       r> drop exit
154     then
155     r> 0=
156   until
157 ;
158
159 : load-pnp
160   0 to end_of_file?
161   reset_line_reading
162   s" /boot/pnpid.conf" O_RDONLY fopen fd !
163   fd @ -1 <> if
164     begin
165       end_of_file? 0=
166     while
167       read_line
168       check-pnpid
169     repeat
170     fd @ fclose
171   then
172 ;
173