Commit | Line | Data |
---|---|---|
920dae64 AT |
1 | \ ========== Copyright Header Begin ========================================== |
2 | \ | |
3 | \ Hypervisor Software File: probe.fth | |
4 | \ | |
5 | \ Copyright (c) 2006 Sun Microsystems, Inc. All Rights Reserved. | |
6 | \ | |
7 | \ - Do no alter or remove copyright notices | |
8 | \ | |
9 | \ - Redistribution and use of this software in source and binary forms, with | |
10 | \ or without modification, are permitted provided that the following | |
11 | \ conditions are met: | |
12 | \ | |
13 | \ - Redistribution of source code must retain the above copyright notice, | |
14 | \ this list of conditions and the following disclaimer. | |
15 | \ | |
16 | \ - Redistribution in binary form must reproduce the above copyright notice, | |
17 | \ this list of conditions and the following disclaimer in the | |
18 | \ documentation and/or other materials provided with the distribution. | |
19 | \ | |
20 | \ Neither the name of Sun Microsystems, Inc. or the names of contributors | |
21 | \ may be used to endorse or promote products derived from this software | |
22 | \ without specific prior written permission. | |
23 | \ | |
24 | \ This software is provided "AS IS," without a warranty of any kind. | |
25 | \ ALL EXPRESS OR IMPLIED CONDITIONS, REPRESENTATIONS AND WARRANTIES, | |
26 | \ INCLUDING ANY IMPLIED WARRANTY OF MERCHANTABILITY, FITNESS FOR A | |
27 | \ PARTICULAR PURPOSE OR NON-INFRINGEMENT, ARE HEREBY EXCLUDED. SUN | |
28 | \ MICROSYSTEMS, INC. ("SUN") AND ITS LICENSORS SHALL NOT BE LIABLE FOR | |
29 | \ ANY DAMAGES SUFFERED BY LICENSEE AS A RESULT OF USING, MODIFYING OR | |
30 | \ DISTRIBUTING THIS SOFTWARE OR ITS DERIVATIVES. IN NO EVENT WILL SUN | |
31 | \ OR ITS LICENSORS BE LIABLE FOR ANY LOST REVENUE, PROFIT OR DATA, OR | |
32 | \ FOR DIRECT, INDIRECT, SPECIAL, CONSEQUENTIAL, INCIDENTAL OR PUNITIVE | |
33 | \ DAMAGES, HOWEVER CAUSED AND REGARDLESS OF THE THEORY OF LIABILITY, | |
34 | \ ARISING OUT OF THE USE OF OR INABILITY TO USE THIS SOFTWARE, EVEN IF | |
35 | \ SUN HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGES. | |
36 | \ | |
37 | \ You acknowledge that this software is not designed, licensed or | |
38 | \ intended for use in the design, construction, operation or maintenance of | |
39 | \ any nuclear facility. | |
40 | \ | |
41 | \ ========== Copyright Header End ============================================ | |
42 | id: @(#)probe.fth 1.1 07/01/04 | |
43 | purpose: OHCI USB Controller probe | |
44 | copyright: Copyright 2007 Sun Microsystems, Inc. All Rights Reserved | |
45 | \ See license at end of file | |
46 | ||
47 | hex | |
48 | headers | |
49 | ||
50 | : enable-root-hub-port ( port -- ) | |
51 | >r | |
52 | h# 1.0002 r@ hc-rh-psta! \ enable port | |
53 | 10 r@ hc-rh-psta! \ reset port | |
54 | r@ d# 10 0 do | |
55 | d# 10 ms | |
56 | dup hc-rh-psta@ 10.0000 and ?leave | |
57 | loop drop | |
58 | r@ hc-rh-psta@ 10.0000 and 0= if abort then | |
59 | h# 1f.0000 r> hc-rh-psta! \ clear status change bits | |
60 | 100 ms | |
61 | ; | |
62 | ||
63 | : probe-root-hub-port ( port -- ) | |
64 | dup hc-rh-psta@ 1 and 0= if drop exit then \ No device connected | |
65 | ok-to-add-device? 0= if drop exit then \ Can't add another device | |
66 | ||
67 | dup enable-root-hub-port ( port ) | |
68 | new-address ( port dev ) | |
69 | over hc-rh-psta@ 200 and if speed-low else speed-full then over di-speed! | |
70 | ||
71 | 0 set-target ( port dev ) \ Address it as device 0 | |
72 | dup set-address if 2drop exit then ( port dev ) \ Assign it usb addr dev | |
73 | dup set-target ( port dev ) \ Address it as device dev | |
74 | swap 1+ swap \ port numbers are 1-based | |
75 | make-device-node ( ) | |
76 | ; | |
77 | ||
78 | false value ports-powered? | |
79 | ||
80 | external | |
81 | : power-usb-ports ( -- ) | |
82 | hc-rh-desa@ dup h# 200 and 0= if | |
83 | \ ports are power switched | |
84 | hc-rh-stat@ h# 1.0000 or hc-rh-stat! \ power all ports | |
85 | hc-rh-desb@ d# 17 >> over h# ff and 0 ?do | |
86 | dup 1 i << and if | |
87 | i hc-rh-psta@ h# 100 or i hc-rh-psta! \ power port | |
88 | then | |
89 | loop drop | |
90 | then drop | |
91 | potpgt 2* ms \ Wait until powergood | |
92 | true to ports-powered? | |
93 | ; | |
94 | ||
95 | : probe-usb ( -- ) | |
96 | \ Power on ports | |
97 | ports-powered? not if power-usb-ports then | |
98 | ||
99 | \ Setup PowerOnToPowerGoodTime and OverCurrentProtectionMode | |
100 | hc-rh-desA@ dup h# 00ff.ffff and | |
101 | h# 800 or potpgt d# 24 << or hc-rh-desA! \ per-port over-current status | |
102 | ||
103 | \ Probe each port | |
104 | alloc-pkt-buf | |
105 | h# ff and 0 do | |
106 | i ['] probe-root-hub-port catch if | |
107 | drop ." Failed to probe root port " i u. cr | |
108 | then | |
109 | loop | |
110 | free-pkt-buf | |
111 | ; | |
112 | ||
113 | ||
114 | \ LICENSE_BEGIN | |
115 | \ Copyright (c) 2006 FirmWorks | |
116 | \ | |
117 | \ Permission is hereby granted, free of charge, to any person obtaining | |
118 | \ a copy of this software and associated documentation files (the | |
119 | \ "Software"), to deal in the Software without restriction, including | |
120 | \ without limitation the rights to use, copy, modify, merge, publish, | |
121 | \ distribute, sublicense, and/or sell copies of the Software, and to | |
122 | \ permit persons to whom the Software is furnished to do so, subject to | |
123 | \ the following conditions: | |
124 | \ | |
125 | \ The above copyright notice and this permission notice shall be | |
126 | \ included in all copies or substantial portions of the Software. | |
127 | \ | |
128 | \ THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | |
129 | \ EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | |
130 | \ MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | |
131 | \ NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE | |
132 | \ LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION | |
133 | \ OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION | |
134 | \ WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. | |
135 | \ | |
136 | \ LICENSE_END |