Commit | Line | Data |
---|---|---|
920dae64 AT |
1 | \ ========== Copyright Header Begin ========================================== |
2 | \ | |
3 | \ Hypervisor Software File: mif.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: @(#)mif.fth 1.1 06/02/16 | |
43 | purpose: Intel Ophir/82571 PHY access routines | |
44 | copyright: Copyright 2006 Sun Microsystems, Inc. All Rights Reserved | |
45 | copyright: Use is subject to license terms. | |
46 | ||
47 | headers | |
48 | ||
49 | \ Routines to access the phy using the MDIO Auto-access method | |
50 | ||
51 | 1 value phy-adr \ Internal phy address | |
52 | ||
53 | 1 d# 28 << constant phy-ready-bit | |
54 | 1 d# 30 << constant phy-error-bit | |
55 | ||
56 | : mdi@ ( -- value ) h# 20 reg@ ; | |
57 | : mdi! ( value -- ) h# 20 reg! ; | |
58 | ||
59 | \ | |
60 | \ Loop (for an arbitrarily chosen number of times) | |
61 | \ until the ready-bit goes clear or we run out of loops. | |
62 | \ At the end, return 0 if the ready bit is set and the error bit is | |
63 | \ clear, else return non-zero. | |
64 | \ Also, clear the error bit for the next access. | |
65 | \ | |
66 | : phy-cmd-timeout? ( -- error? ) | |
67 | d# 5000 \ ... whatever ... | |
68 | begin ( loops ) | |
69 | 1- dup 0< ( loops timeout? ) | |
70 | mdi@ phy-ready-bit and ( loops timeout? complete? ) | |
71 | or ( loops done? ) | |
72 | until ( loops ) | |
73 | drop mdi@ ( reg-val ) | |
74 | dup phy-error-bit and 0<> ( reg-val error? ) | |
75 | swap phy-ready-bit and 0= or ( error? ) | |
76 | ; | |
77 | ||
78 | : phy-val ( data reg-addr read? -- val ) | |
79 | if 2 else 1 then ( data reg-addr ) | |
80 | d# 26 << ( data reg-addr val0 ) | |
81 | phy-adr h# 1f and d# 21 << or ( data reg-adr val1 ) \ shift in phy adr | |
82 | swap h# 1f and d# 16 << or ( data ) \ shift in reg adr | |
83 | swap h# ffff and or ( ) | |
84 | ; | |
85 | ||
86 | : phy@ ( reg-adr -- data ) | |
87 | 0 swap true phy-val mdi! ( ) | |
88 | phy-cmd-timeout? ( timeout? ) | |
89 | mdi@ h# ffff and ( timeout? data ) | |
90 | nip ( data ) \ Throw away error! | |
91 | ; | |
92 | ||
93 | : phy! ( data reg-adr -- ) | |
94 | false phy-val mdi! ( ) | |
95 | phy-cmd-timeout? ( error? ) | |
96 | drop ( ) \ Throw away error! | |
97 | ; |