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#include "vf.h"
29
30static s32 e1000_check_for_link_vf(struct e1000_hw *hw);
31static s32 e1000_get_link_up_info_vf(struct e1000_hw *hw, u16 *speed,
32 u16 *duplex);
33static s32 e1000_init_hw_vf(struct e1000_hw *hw);
34static s32 e1000_reset_hw_vf(struct e1000_hw *hw);
35
36static void e1000_update_mc_addr_list_vf(struct e1000_hw *hw, u8 *,
37 u32, u32, u32);
38static void e1000_rar_set_vf(struct e1000_hw *, u8 *, u32);
39static s32 e1000_read_mac_addr_vf(struct e1000_hw *);
40static s32 e1000_set_uc_addr_vf(struct e1000_hw *hw, u32 subcmd, u8 *addr);
41static s32 e1000_set_vfta_vf(struct e1000_hw *, u16, bool);
42
43
44
45
46
47static s32 e1000_init_mac_params_vf(struct e1000_hw *hw)
48{
49 struct e1000_mac_info *mac = &hw->mac;
50
51
52 mac->mta_reg_count = 128;
53
54 mac->rar_entry_count = 1;
55
56
57
58 mac->ops.reset_hw = e1000_reset_hw_vf;
59
60 mac->ops.init_hw = e1000_init_hw_vf;
61
62 mac->ops.check_for_link = e1000_check_for_link_vf;
63
64 mac->ops.get_link_up_info = e1000_get_link_up_info_vf;
65
66 mac->ops.update_mc_addr_list = e1000_update_mc_addr_list_vf;
67
68 mac->ops.rar_set = e1000_rar_set_vf;
69
70 mac->ops.read_mac_addr = e1000_read_mac_addr_vf;
71
72 mac->ops.set_uc_addr = e1000_set_uc_addr_vf;
73
74 mac->ops.set_vfta = e1000_set_vfta_vf;
75
76 return E1000_SUCCESS;
77}
78
79
80
81
82
83void e1000_init_function_pointers_vf(struct e1000_hw *hw)
84{
85 hw->mac.ops.init_params = e1000_init_mac_params_vf;
86 hw->mbx.ops.init_params = e1000_init_mbx_params_vf;
87}
88
89
90
91
92
93
94
95
96
97
98static s32 e1000_get_link_up_info_vf(struct e1000_hw *hw, u16 *speed,
99 u16 *duplex)
100{
101 s32 status;
102
103 status = er32(STATUS);
104 if (status & E1000_STATUS_SPEED_1000)
105 *speed = SPEED_1000;
106 else if (status & E1000_STATUS_SPEED_100)
107 *speed = SPEED_100;
108 else
109 *speed = SPEED_10;
110
111 if (status & E1000_STATUS_FD)
112 *duplex = FULL_DUPLEX;
113 else
114 *duplex = HALF_DUPLEX;
115
116 return E1000_SUCCESS;
117}
118
119
120
121
122
123
124
125
126static s32 e1000_reset_hw_vf(struct e1000_hw *hw)
127{
128 struct e1000_mbx_info *mbx = &hw->mbx;
129 u32 timeout = E1000_VF_INIT_TIMEOUT;
130 u32 ret_val = -E1000_ERR_MAC_INIT;
131 u32 msgbuf[3];
132 u8 *addr = (u8 *)(&msgbuf[1]);
133 u32 ctrl;
134
135
136 ctrl = er32(CTRL);
137 ew32(CTRL, ctrl | E1000_CTRL_RST);
138
139
140 while (!mbx->ops.check_for_rst(hw) && timeout) {
141 timeout--;
142 udelay(5);
143 }
144
145 if (timeout) {
146
147 mbx->timeout = E1000_VF_MBX_INIT_TIMEOUT;
148
149
150 msgbuf[0] = E1000_VF_RESET;
151 mbx->ops.write_posted(hw, msgbuf, 1);
152
153 mdelay(10);
154
155
156 ret_val = mbx->ops.read_posted(hw, msgbuf, 3);
157 if (!ret_val) {
158 if (msgbuf[0] == (E1000_VF_RESET |
159 E1000_VT_MSGTYPE_ACK))
160 memcpy(hw->mac.perm_addr, addr, ETH_ALEN);
161 else
162 ret_val = -E1000_ERR_MAC_INIT;
163 }
164 }
165
166 return ret_val;
167}
168
169
170
171
172
173
174
175static s32 e1000_init_hw_vf(struct e1000_hw *hw)
176{
177
178 e1000_rar_set_vf(hw, hw->mac.addr, 0);
179
180 return E1000_SUCCESS;
181}
182
183
184
185
186
187
188
189
190
191
192static u32 e1000_hash_mc_addr_vf(struct e1000_hw *hw, u8 *mc_addr)
193{
194 u32 hash_value, hash_mask;
195 u8 bit_shift = 0;
196
197
198 hash_mask = (hw->mac.mta_reg_count * 32) - 1;
199
200
201
202
203 while (hash_mask >> bit_shift != 0xFF)
204 bit_shift++;
205
206 hash_value = hash_mask & (((mc_addr[4] >> (8 - bit_shift)) |
207 (((u16)mc_addr[5]) << bit_shift)));
208
209 return hash_value;
210}
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225static void e1000_update_mc_addr_list_vf(struct e1000_hw *hw,
226 u8 *mc_addr_list, u32 mc_addr_count,
227 u32 rar_used_count, u32 rar_count)
228{
229 struct e1000_mbx_info *mbx = &hw->mbx;
230 u32 msgbuf[E1000_VFMAILBOX_SIZE];
231 u16 *hash_list = (u16 *)&msgbuf[1];
232 u32 hash_value;
233 u32 cnt, i;
234 s32 ret_val;
235
236
237
238
239
240
241
242
243
244
245 cnt = (mc_addr_count > 30) ? 30 : mc_addr_count;
246 msgbuf[0] = E1000_VF_SET_MULTICAST;
247 msgbuf[0] |= cnt << E1000_VT_MSGINFO_SHIFT;
248
249 for (i = 0; i < cnt; i++) {
250 hash_value = e1000_hash_mc_addr_vf(hw, mc_addr_list);
251 hash_list[i] = hash_value & 0x0FFFF;
252 mc_addr_list += ETH_ALEN;
253 }
254
255 ret_val = mbx->ops.write_posted(hw, msgbuf, E1000_VFMAILBOX_SIZE);
256 if (!ret_val)
257 mbx->ops.read_posted(hw, msgbuf, 1);
258}
259
260
261
262
263
264
265
266static s32 e1000_set_vfta_vf(struct e1000_hw *hw, u16 vid, bool set)
267{
268 struct e1000_mbx_info *mbx = &hw->mbx;
269 u32 msgbuf[2];
270 s32 err;
271
272 msgbuf[0] = E1000_VF_SET_VLAN;
273 msgbuf[1] = vid;
274
275 if (set)
276 msgbuf[0] |= BIT(E1000_VT_MSGINFO_SHIFT);
277
278 mbx->ops.write_posted(hw, msgbuf, 2);
279
280 err = mbx->ops.read_posted(hw, msgbuf, 2);
281
282 msgbuf[0] &= ~E1000_VT_MSGTYPE_CTS;
283
284
285 if (!err && (msgbuf[0] == (E1000_VF_SET_VLAN | E1000_VT_MSGTYPE_NACK)))
286 err = -E1000_ERR_MAC_INIT;
287
288 return err;
289}
290
291
292
293
294
295
296void e1000_rlpml_set_vf(struct e1000_hw *hw, u16 max_size)
297{
298 struct e1000_mbx_info *mbx = &hw->mbx;
299 u32 msgbuf[2];
300 s32 ret_val;
301
302 msgbuf[0] = E1000_VF_SET_LPE;
303 msgbuf[1] = max_size;
304
305 ret_val = mbx->ops.write_posted(hw, msgbuf, 2);
306 if (!ret_val)
307 mbx->ops.read_posted(hw, msgbuf, 1);
308}
309
310
311
312
313
314
315
316static void e1000_rar_set_vf(struct e1000_hw *hw, u8 *addr, u32 index)
317{
318 struct e1000_mbx_info *mbx = &hw->mbx;
319 u32 msgbuf[3];
320 u8 *msg_addr = (u8 *)(&msgbuf[1]);
321 s32 ret_val;
322
323 memset(msgbuf, 0, 12);
324 msgbuf[0] = E1000_VF_SET_MAC_ADDR;
325 memcpy(msg_addr, addr, ETH_ALEN);
326 ret_val = mbx->ops.write_posted(hw, msgbuf, 3);
327
328 if (!ret_val)
329 ret_val = mbx->ops.read_posted(hw, msgbuf, 3);
330
331 msgbuf[0] &= ~E1000_VT_MSGTYPE_CTS;
332
333
334 if (!ret_val &&
335 (msgbuf[0] == (E1000_VF_SET_MAC_ADDR | E1000_VT_MSGTYPE_NACK)))
336 e1000_read_mac_addr_vf(hw);
337}
338
339
340
341
342
343static s32 e1000_read_mac_addr_vf(struct e1000_hw *hw)
344{
345 memcpy(hw->mac.addr, hw->mac.perm_addr, ETH_ALEN);
346
347 return E1000_SUCCESS;
348}
349
350
351
352
353
354
355
356static s32 e1000_set_uc_addr_vf(struct e1000_hw *hw, u32 sub_cmd, u8 *addr)
357{
358 struct e1000_mbx_info *mbx = &hw->mbx;
359 u32 msgbuf[3], msgbuf_chk;
360 u8 *msg_addr = (u8 *)(&msgbuf[1]);
361 s32 ret_val;
362
363 memset(msgbuf, 0, sizeof(msgbuf));
364 msgbuf[0] |= sub_cmd;
365 msgbuf[0] |= E1000_VF_SET_MAC_ADDR;
366 msgbuf_chk = msgbuf[0];
367
368 if (addr)
369 memcpy(msg_addr, addr, ETH_ALEN);
370
371 ret_val = mbx->ops.write_posted(hw, msgbuf, 3);
372
373 if (!ret_val)
374 ret_val = mbx->ops.read_posted(hw, msgbuf, 3);
375
376 msgbuf[0] &= ~E1000_VT_MSGTYPE_CTS;
377
378 if (!ret_val) {
379 msgbuf[0] &= ~E1000_VT_MSGTYPE_CTS;
380
381 if (msgbuf[0] == (msgbuf_chk | E1000_VT_MSGTYPE_NACK))
382 return -ENOSPC;
383 }
384
385 return ret_val;
386}
387
388
389
390
391
392
393
394
395
396static s32 e1000_check_for_link_vf(struct e1000_hw *hw)
397{
398 struct e1000_mbx_info *mbx = &hw->mbx;
399 struct e1000_mac_info *mac = &hw->mac;
400 s32 ret_val = E1000_SUCCESS;
401 u32 in_msg = 0;
402
403
404
405
406
407
408
409 if (!mbx->ops.check_for_rst(hw) || !mbx->timeout)
410 mac->get_link_status = true;
411
412 if (!mac->get_link_status)
413 goto out;
414
415
416 if (!(er32(STATUS) & E1000_STATUS_LU))
417 goto out;
418
419
420
421
422 if (mbx->ops.read(hw, &in_msg, 1))
423 goto out;
424
425
426 if (!(in_msg & E1000_VT_MSGTYPE_CTS)) {
427
428 if (in_msg & E1000_VT_MSGTYPE_NACK)
429 ret_val = -E1000_ERR_MAC_INIT;
430 goto out;
431 }
432
433
434 if (!mbx->timeout) {
435 ret_val = -E1000_ERR_MAC_INIT;
436 goto out;
437 }
438
439
440
441
442 mac->get_link_status = false;
443
444out:
445 return ret_val;
446}
447
448