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