This source file includes following definitions.
- mii_bitbang_sync
- mii_bitbang_sendbits
- mii_bitbang_readreg
- mii_bitbang_writereg
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 #include <sys/param.h>
46 #include <sys/device.h>
47
48 #include <dev/mii/mii.h>
49 #include <dev/mii/mii_bitbang.h>
50
51 void mii_bitbang_sync(struct device *, mii_bitbang_ops_t);
52 void mii_bitbang_sendbits(struct device *, mii_bitbang_ops_t,
53 u_int32_t, int);
54
55 #define WRITE(x) \
56 do { \
57 ops->mbo_write(sc, (x)); \
58 delay(1); \
59 } while (0)
60
61 #define READ ops->mbo_read(sc)
62
63 #define MDO ops->mbo_bits[MII_BIT_MDO]
64 #define MDI ops->mbo_bits[MII_BIT_MDI]
65 #define MDC ops->mbo_bits[MII_BIT_MDC]
66 #define MDIRPHY ops->mbo_bits[MII_BIT_DIR_HOST_PHY]
67 #define MDIRHOST ops->mbo_bits[MII_BIT_DIR_PHY_HOST]
68
69
70
71
72
73
74 void
75 mii_bitbang_sync(struct device *sc, mii_bitbang_ops_t ops)
76 {
77 int i;
78 u_int32_t v;
79
80 v = MDIRPHY | MDO;
81
82 WRITE(v);
83 for (i = 0; i < 32; i++) {
84 WRITE(v | MDC);
85 WRITE(v);
86 }
87 }
88
89
90
91
92
93
94 void
95 mii_bitbang_sendbits(struct device *sc, mii_bitbang_ops_t ops,
96 u_int32_t data, int nbits)
97 {
98 int i;
99 u_int32_t v;
100
101 v = MDIRPHY;
102 WRITE(v);
103
104 for (i = 1 << (nbits - 1); i != 0; i >>= 1) {
105 if (data & i)
106 v |= MDO;
107 else
108 v &= ~MDO;
109 WRITE(v);
110 WRITE(v | MDC);
111 WRITE(v);
112 }
113 }
114
115
116
117
118
119
120 int
121 mii_bitbang_readreg(struct device *sc, mii_bitbang_ops_t ops, int phy,
122 int reg)
123 {
124 int val = 0, err = 0, i;
125
126 mii_bitbang_sync(sc, ops);
127
128 mii_bitbang_sendbits(sc, ops, MII_COMMAND_START, 2);
129 mii_bitbang_sendbits(sc, ops, MII_COMMAND_READ, 2);
130 mii_bitbang_sendbits(sc, ops, phy, 5);
131 mii_bitbang_sendbits(sc, ops, reg, 5);
132
133
134 WRITE(MDIRHOST);
135
136
137 WRITE(MDIRHOST | MDC);
138 WRITE(MDIRHOST);
139
140
141 err = READ & MDI;
142
143
144 WRITE(MDIRHOST | MDC);
145 WRITE(MDIRHOST);
146
147 for (i = 0; i < 16; i++) {
148 val <<= 1;
149
150 if (err == 0 && (READ & MDI) != 0)
151 val |= 1;
152
153 WRITE(MDIRHOST | MDC);
154 WRITE(MDIRHOST);
155 }
156
157
158 WRITE(MDIRPHY);
159
160 return (err ? 0 : val);
161 }
162
163
164
165
166
167
168 void
169 mii_bitbang_writereg(struct device *sc, mii_bitbang_ops_t ops,
170 int phy, int reg, int val)
171 {
172
173 mii_bitbang_sync(sc, ops);
174
175 mii_bitbang_sendbits(sc, ops, MII_COMMAND_START, 2);
176 mii_bitbang_sendbits(sc, ops, MII_COMMAND_WRITE, 2);
177 mii_bitbang_sendbits(sc, ops, phy, 5);
178 mii_bitbang_sendbits(sc, ops, reg, 5);
179 mii_bitbang_sendbits(sc, ops, MII_COMMAND_ACK, 2);
180 mii_bitbang_sendbits(sc, ops, val, 16);
181
182 WRITE(MDIRPHY);
183 }