1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include "e1000.h"
23
24
25
26
27
28
29
30
31
32static u8 e1000_calculate_checksum(u8 *buffer, u32 length)
33{
34 u32 i;
35 u8 sum = 0;
36
37 if (!buffer)
38 return 0;
39
40 for (i = 0; i < length; i++)
41 sum += buffer[i];
42
43 return (u8)(0 - sum);
44}
45
46
47
48
49
50
51
52
53
54
55
56static s32 e1000_mng_enable_host_if(struct e1000_hw *hw)
57{
58 u32 hicr;
59 u8 i;
60
61 if (!hw->mac.arc_subsystem_valid) {
62 e_dbg("ARC subsystem not valid.\n");
63 return -E1000_ERR_HOST_INTERFACE_COMMAND;
64 }
65
66
67 hicr = er32(HICR);
68 if (!(hicr & E1000_HICR_EN)) {
69 e_dbg("E1000_HOST_EN bit disabled.\n");
70 return -E1000_ERR_HOST_INTERFACE_COMMAND;
71 }
72
73 for (i = 0; i < E1000_MNG_DHCP_COMMAND_TIMEOUT; i++) {
74 hicr = er32(HICR);
75 if (!(hicr & E1000_HICR_C))
76 break;
77 mdelay(1);
78 }
79
80 if (i == E1000_MNG_DHCP_COMMAND_TIMEOUT) {
81 e_dbg("Previous command timeout failed.\n");
82 return -E1000_ERR_HOST_INTERFACE_COMMAND;
83 }
84
85 return 0;
86}
87
88
89
90
91
92
93
94
95bool e1000e_check_mng_mode_generic(struct e1000_hw *hw)
96{
97 u32 fwsm = er32(FWSM);
98
99 return (fwsm & E1000_FWSM_MODE_MASK) ==
100 (E1000_MNG_IAMT_MODE << E1000_FWSM_MODE_SHIFT);
101}
102
103
104
105
106
107
108
109
110bool e1000e_enable_tx_pkt_filtering(struct e1000_hw *hw)
111{
112 struct e1000_host_mng_dhcp_cookie *hdr = &hw->mng_cookie;
113 u32 *buffer = (u32 *)&hw->mng_cookie;
114 u32 offset;
115 s32 ret_val, hdr_csum, csum;
116 u8 i, len;
117
118 hw->mac.tx_pkt_filtering = true;
119
120
121 if (!hw->mac.ops.check_mng_mode(hw)) {
122 hw->mac.tx_pkt_filtering = false;
123 return hw->mac.tx_pkt_filtering;
124 }
125
126
127
128
129 ret_val = e1000_mng_enable_host_if(hw);
130 if (ret_val) {
131 hw->mac.tx_pkt_filtering = false;
132 return hw->mac.tx_pkt_filtering;
133 }
134
135
136 len = E1000_MNG_DHCP_COOKIE_LENGTH >> 2;
137 offset = E1000_MNG_DHCP_COOKIE_OFFSET >> 2;
138 for (i = 0; i < len; i++)
139 *(buffer + i) = E1000_READ_REG_ARRAY(hw, E1000_HOST_IF,
140 offset + i);
141 hdr_csum = hdr->checksum;
142 hdr->checksum = 0;
143 csum = e1000_calculate_checksum((u8 *)hdr,
144 E1000_MNG_DHCP_COOKIE_LENGTH);
145
146
147
148
149 if ((hdr_csum != csum) || (hdr->signature != E1000_IAMT_SIGNATURE)) {
150 hw->mac.tx_pkt_filtering = true;
151 return hw->mac.tx_pkt_filtering;
152 }
153
154
155 if (!(hdr->status & E1000_MNG_DHCP_COOKIE_STATUS_PARSING))
156 hw->mac.tx_pkt_filtering = false;
157
158 return hw->mac.tx_pkt_filtering;
159}
160
161
162
163
164
165
166
167
168static s32 e1000_mng_write_cmd_header(struct e1000_hw *hw,
169 struct e1000_host_mng_command_header *hdr)
170{
171 u16 i, length = sizeof(struct e1000_host_mng_command_header);
172
173
174
175 hdr->checksum = e1000_calculate_checksum((u8 *)hdr, length);
176
177 length >>= 2;
178
179 for (i = 0; i < length; i++) {
180 E1000_WRITE_REG_ARRAY(hw, E1000_HOST_IF, i, *((u32 *)hdr + i));
181 e1e_flush();
182 }
183
184 return 0;
185}
186
187
188
189
190
191
192
193
194
195
196
197
198
199static s32 e1000_mng_host_if_write(struct e1000_hw *hw, u8 *buffer,
200 u16 length, u16 offset, u8 *sum)
201{
202 u8 *tmp;
203 u8 *bufptr = buffer;
204 u32 data = 0;
205 u16 remaining, i, j, prev_bytes;
206
207
208
209 if (length == 0 || offset + length > E1000_HI_MAX_MNG_DATA_LENGTH)
210 return -E1000_ERR_PARAM;
211
212 tmp = (u8 *)&data;
213 prev_bytes = offset & 0x3;
214 offset >>= 2;
215
216 if (prev_bytes) {
217 data = E1000_READ_REG_ARRAY(hw, E1000_HOST_IF, offset);
218 for (j = prev_bytes; j < sizeof(u32); j++) {
219 *(tmp + j) = *bufptr++;
220 *sum += *(tmp + j);
221 }
222 E1000_WRITE_REG_ARRAY(hw, E1000_HOST_IF, offset, data);
223 length -= j - prev_bytes;
224 offset++;
225 }
226
227 remaining = length & 0x3;
228 length -= remaining;
229
230
231 length >>= 2;
232
233
234
235
236 for (i = 0; i < length; i++) {
237 for (j = 0; j < sizeof(u32); j++) {
238 *(tmp + j) = *bufptr++;
239 *sum += *(tmp + j);
240 }
241
242 E1000_WRITE_REG_ARRAY(hw, E1000_HOST_IF, offset + i, data);
243 }
244 if (remaining) {
245 for (j = 0; j < sizeof(u32); j++) {
246 if (j < remaining)
247 *(tmp + j) = *bufptr++;
248 else
249 *(tmp + j) = 0;
250
251 *sum += *(tmp + j);
252 }
253 E1000_WRITE_REG_ARRAY(hw, E1000_HOST_IF, offset + i, data);
254 }
255
256 return 0;
257}
258
259
260
261
262
263
264
265
266
267s32 e1000e_mng_write_dhcp_info(struct e1000_hw *hw, u8 *buffer, u16 length)
268{
269 struct e1000_host_mng_command_header hdr;
270 s32 ret_val;
271 u32 hicr;
272
273 hdr.command_id = E1000_MNG_DHCP_TX_PAYLOAD_CMD;
274 hdr.command_length = length;
275 hdr.reserved1 = 0;
276 hdr.reserved2 = 0;
277 hdr.checksum = 0;
278
279
280 ret_val = e1000_mng_enable_host_if(hw);
281 if (ret_val)
282 return ret_val;
283
284
285 ret_val = e1000_mng_host_if_write(hw, buffer, length,
286 sizeof(hdr), &(hdr.checksum));
287 if (ret_val)
288 return ret_val;
289
290
291 ret_val = e1000_mng_write_cmd_header(hw, &hdr);
292 if (ret_val)
293 return ret_val;
294
295
296 hicr = er32(HICR);
297 ew32(HICR, hicr | E1000_HICR_C);
298
299 return 0;
300}
301
302
303
304
305
306
307
308
309bool e1000e_enable_mng_pass_thru(struct e1000_hw *hw)
310{
311 u32 manc;
312 u32 fwsm, factps;
313
314 manc = er32(MANC);
315
316 if (!(manc & E1000_MANC_RCV_TCO_EN))
317 return false;
318
319 if (hw->mac.has_fwsm) {
320 fwsm = er32(FWSM);
321 factps = er32(FACTPS);
322
323 if (!(factps & E1000_FACTPS_MNGCG) &&
324 ((fwsm & E1000_FWSM_MODE_MASK) ==
325 (e1000_mng_mode_pt << E1000_FWSM_MODE_SHIFT)))
326 return true;
327 } else if ((hw->mac.type == e1000_82574) ||
328 (hw->mac.type == e1000_82583)) {
329 u16 data;
330 s32 ret_val;
331
332 factps = er32(FACTPS);
333 ret_val = e1000_read_nvm(hw, NVM_INIT_CONTROL2_REG, 1, &data);
334 if (ret_val)
335 return false;
336
337 if (!(factps & E1000_FACTPS_MNGCG) &&
338 ((data & E1000_NVM_INIT_CTRL2_MNGM) ==
339 (e1000_mng_mode_pt << 13)))
340 return true;
341 } else if ((manc & E1000_MANC_SMBUS_EN) &&
342 !(manc & E1000_MANC_ASF_EN)) {
343 return true;
344 }
345
346 return false;
347}
348