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#include "e1000.h"
34
35static s32 e1000_check_downshift(struct e1000_hw *hw);
36static s32 e1000_check_polarity(struct e1000_hw *hw,
37 e1000_rev_polarity *polarity);
38static void e1000_clear_hw_cntrs(struct e1000_hw *hw);
39static void e1000_clear_vfta(struct e1000_hw *hw);
40static s32 e1000_config_dsp_after_link_change(struct e1000_hw *hw,
41 bool link_up);
42static s32 e1000_config_fc_after_link_up(struct e1000_hw *hw);
43static s32 e1000_detect_gig_phy(struct e1000_hw *hw);
44static s32 e1000_get_auto_rd_done(struct e1000_hw *hw);
45static s32 e1000_get_cable_length(struct e1000_hw *hw, u16 *min_length,
46 u16 *max_length);
47static s32 e1000_get_phy_cfg_done(struct e1000_hw *hw);
48static s32 e1000_id_led_init(struct e1000_hw *hw);
49static void e1000_init_rx_addrs(struct e1000_hw *hw);
50static s32 e1000_phy_igp_get_info(struct e1000_hw *hw,
51 struct e1000_phy_info *phy_info);
52static s32 e1000_phy_m88_get_info(struct e1000_hw *hw,
53 struct e1000_phy_info *phy_info);
54static s32 e1000_set_d3_lplu_state(struct e1000_hw *hw, bool active);
55static s32 e1000_wait_autoneg(struct e1000_hw *hw);
56static void e1000_write_reg_io(struct e1000_hw *hw, u32 offset, u32 value);
57static s32 e1000_set_phy_type(struct e1000_hw *hw);
58static void e1000_phy_init_script(struct e1000_hw *hw);
59static s32 e1000_setup_copper_link(struct e1000_hw *hw);
60static s32 e1000_setup_fiber_serdes_link(struct e1000_hw *hw);
61static s32 e1000_adjust_serdes_amplitude(struct e1000_hw *hw);
62static s32 e1000_phy_force_speed_duplex(struct e1000_hw *hw);
63static s32 e1000_config_mac_to_phy(struct e1000_hw *hw);
64static void e1000_raise_mdi_clk(struct e1000_hw *hw, u32 *ctrl);
65static void e1000_lower_mdi_clk(struct e1000_hw *hw, u32 *ctrl);
66static void e1000_shift_out_mdi_bits(struct e1000_hw *hw, u32 data, u16 count);
67static u16 e1000_shift_in_mdi_bits(struct e1000_hw *hw);
68static s32 e1000_phy_reset_dsp(struct e1000_hw *hw);
69static s32 e1000_write_eeprom_spi(struct e1000_hw *hw, u16 offset,
70 u16 words, u16 *data);
71static s32 e1000_write_eeprom_microwire(struct e1000_hw *hw, u16 offset,
72 u16 words, u16 *data);
73static s32 e1000_spi_eeprom_ready(struct e1000_hw *hw);
74static void e1000_raise_ee_clk(struct e1000_hw *hw, u32 *eecd);
75static void e1000_lower_ee_clk(struct e1000_hw *hw, u32 *eecd);
76static void e1000_shift_out_ee_bits(struct e1000_hw *hw, u16 data, u16 count);
77static s32 e1000_write_phy_reg_ex(struct e1000_hw *hw, u32 reg_addr,
78 u16 phy_data);
79static s32 e1000_read_phy_reg_ex(struct e1000_hw *hw, u32 reg_addr,
80 u16 *phy_data);
81static u16 e1000_shift_in_ee_bits(struct e1000_hw *hw, u16 count);
82static s32 e1000_acquire_eeprom(struct e1000_hw *hw);
83static void e1000_release_eeprom(struct e1000_hw *hw);
84static void e1000_standby_eeprom(struct e1000_hw *hw);
85static s32 e1000_set_vco_speed(struct e1000_hw *hw);
86static s32 e1000_polarity_reversal_workaround(struct e1000_hw *hw);
87static s32 e1000_set_phy_mode(struct e1000_hw *hw);
88static s32 e1000_do_read_eeprom(struct e1000_hw *hw, u16 offset, u16 words,
89 u16 *data);
90static s32 e1000_do_write_eeprom(struct e1000_hw *hw, u16 offset, u16 words,
91 u16 *data);
92
93
94static const
95u16 e1000_igp_cable_length_table[IGP01E1000_AGC_LENGTH_TABLE_SIZE] = {
96 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5, 5,
97 5, 10, 10, 10, 10, 10, 10, 10, 20, 20, 20, 20, 20, 25, 25, 25,
98 25, 25, 25, 25, 30, 30, 30, 30, 40, 40, 40, 40, 40, 40, 40, 40,
99 40, 50, 50, 50, 50, 50, 50, 50, 60, 60, 60, 60, 60, 60, 60, 60,
100 60, 70, 70, 70, 70, 70, 70, 80, 80, 80, 80, 80, 80, 90, 90, 90,
101 90, 90, 90, 90, 90, 90, 100, 100, 100, 100, 100, 100, 100, 100, 100,
102 100,
103 100, 100, 100, 100, 110, 110, 110, 110, 110, 110, 110, 110, 110, 110,
104 110, 110,
105 110, 110, 110, 110, 110, 110, 120, 120, 120, 120, 120, 120, 120, 120,
106 120, 120
107};
108
109static DEFINE_MUTEX(e1000_eeprom_lock);
110static DEFINE_SPINLOCK(e1000_phy_lock);
111
112
113
114
115
116static s32 e1000_set_phy_type(struct e1000_hw *hw)
117{
118 if (hw->mac_type == e1000_undefined)
119 return -E1000_ERR_PHY_TYPE;
120
121 switch (hw->phy_id) {
122 case M88E1000_E_PHY_ID:
123 case M88E1000_I_PHY_ID:
124 case M88E1011_I_PHY_ID:
125 case M88E1111_I_PHY_ID:
126 case M88E1118_E_PHY_ID:
127 hw->phy_type = e1000_phy_m88;
128 break;
129 case IGP01E1000_I_PHY_ID:
130 if (hw->mac_type == e1000_82541 ||
131 hw->mac_type == e1000_82541_rev_2 ||
132 hw->mac_type == e1000_82547 ||
133 hw->mac_type == e1000_82547_rev_2)
134 hw->phy_type = e1000_phy_igp;
135 break;
136 case RTL8211B_PHY_ID:
137 hw->phy_type = e1000_phy_8211;
138 break;
139 case RTL8201N_PHY_ID:
140 hw->phy_type = e1000_phy_8201;
141 break;
142 default:
143
144 hw->phy_type = e1000_phy_undefined;
145 return -E1000_ERR_PHY_TYPE;
146 }
147
148 return E1000_SUCCESS;
149}
150
151
152
153
154
155static void e1000_phy_init_script(struct e1000_hw *hw)
156{
157 u32 ret_val;
158 u16 phy_saved_data;
159
160 if (hw->phy_init_script) {
161 msleep(20);
162
163
164
165
166 ret_val = e1000_read_phy_reg(hw, 0x2F5B, &phy_saved_data);
167
168
169 e1000_write_phy_reg(hw, 0x2F5B, 0x0003);
170 msleep(20);
171
172 e1000_write_phy_reg(hw, 0x0000, 0x0140);
173 msleep(5);
174
175 switch (hw->mac_type) {
176 case e1000_82541:
177 case e1000_82547:
178 e1000_write_phy_reg(hw, 0x1F95, 0x0001);
179 e1000_write_phy_reg(hw, 0x1F71, 0xBD21);
180 e1000_write_phy_reg(hw, 0x1F79, 0x0018);
181 e1000_write_phy_reg(hw, 0x1F30, 0x1600);
182 e1000_write_phy_reg(hw, 0x1F31, 0x0014);
183 e1000_write_phy_reg(hw, 0x1F32, 0x161C);
184 e1000_write_phy_reg(hw, 0x1F94, 0x0003);
185 e1000_write_phy_reg(hw, 0x1F96, 0x003F);
186 e1000_write_phy_reg(hw, 0x2010, 0x0008);
187 break;
188
189 case e1000_82541_rev_2:
190 case e1000_82547_rev_2:
191 e1000_write_phy_reg(hw, 0x1F73, 0x0099);
192 break;
193 default:
194 break;
195 }
196
197 e1000_write_phy_reg(hw, 0x0000, 0x3300);
198 msleep(20);
199
200
201 e1000_write_phy_reg(hw, 0x2F5B, phy_saved_data);
202
203 if (hw->mac_type == e1000_82547) {
204 u16 fused, fine, coarse;
205
206
207 e1000_read_phy_reg(hw,
208 IGP01E1000_ANALOG_SPARE_FUSE_STATUS,
209 &fused);
210
211 if (!(fused & IGP01E1000_ANALOG_SPARE_FUSE_ENABLED)) {
212 e1000_read_phy_reg(hw,
213 IGP01E1000_ANALOG_FUSE_STATUS,
214 &fused);
215
216 fine = fused & IGP01E1000_ANALOG_FUSE_FINE_MASK;
217 coarse =
218 fused & IGP01E1000_ANALOG_FUSE_COARSE_MASK;
219
220 if (coarse >
221 IGP01E1000_ANALOG_FUSE_COARSE_THRESH) {
222 coarse -=
223 IGP01E1000_ANALOG_FUSE_COARSE_10;
224 fine -= IGP01E1000_ANALOG_FUSE_FINE_1;
225 } else if (coarse ==
226 IGP01E1000_ANALOG_FUSE_COARSE_THRESH)
227 fine -= IGP01E1000_ANALOG_FUSE_FINE_10;
228
229 fused =
230 (fused & IGP01E1000_ANALOG_FUSE_POLY_MASK) |
231 (fine & IGP01E1000_ANALOG_FUSE_FINE_MASK) |
232 (coarse &
233 IGP01E1000_ANALOG_FUSE_COARSE_MASK);
234
235 e1000_write_phy_reg(hw,
236 IGP01E1000_ANALOG_FUSE_CONTROL,
237 fused);
238 e1000_write_phy_reg(hw,
239 IGP01E1000_ANALOG_FUSE_BYPASS,
240 IGP01E1000_ANALOG_FUSE_ENABLE_SW_CONTROL);
241 }
242 }
243 }
244}
245
246
247
248
249
250s32 e1000_set_mac_type(struct e1000_hw *hw)
251{
252 switch (hw->device_id) {
253 case E1000_DEV_ID_82542:
254 switch (hw->revision_id) {
255 case E1000_82542_2_0_REV_ID:
256 hw->mac_type = e1000_82542_rev2_0;
257 break;
258 case E1000_82542_2_1_REV_ID:
259 hw->mac_type = e1000_82542_rev2_1;
260 break;
261 default:
262
263 return -E1000_ERR_MAC_TYPE;
264 }
265 break;
266 case E1000_DEV_ID_82543GC_FIBER:
267 case E1000_DEV_ID_82543GC_COPPER:
268 hw->mac_type = e1000_82543;
269 break;
270 case E1000_DEV_ID_82544EI_COPPER:
271 case E1000_DEV_ID_82544EI_FIBER:
272 case E1000_DEV_ID_82544GC_COPPER:
273 case E1000_DEV_ID_82544GC_LOM:
274 hw->mac_type = e1000_82544;
275 break;
276 case E1000_DEV_ID_82540EM:
277 case E1000_DEV_ID_82540EM_LOM:
278 case E1000_DEV_ID_82540EP:
279 case E1000_DEV_ID_82540EP_LOM:
280 case E1000_DEV_ID_82540EP_LP:
281 hw->mac_type = e1000_82540;
282 break;
283 case E1000_DEV_ID_82545EM_COPPER:
284 case E1000_DEV_ID_82545EM_FIBER:
285 hw->mac_type = e1000_82545;
286 break;
287 case E1000_DEV_ID_82545GM_COPPER:
288 case E1000_DEV_ID_82545GM_FIBER:
289 case E1000_DEV_ID_82545GM_SERDES:
290 hw->mac_type = e1000_82545_rev_3;
291 break;
292 case E1000_DEV_ID_82546EB_COPPER:
293 case E1000_DEV_ID_82546EB_FIBER:
294 case E1000_DEV_ID_82546EB_QUAD_COPPER:
295 hw->mac_type = e1000_82546;
296 break;
297 case E1000_DEV_ID_82546GB_COPPER:
298 case E1000_DEV_ID_82546GB_FIBER:
299 case E1000_DEV_ID_82546GB_SERDES:
300 case E1000_DEV_ID_82546GB_PCIE:
301 case E1000_DEV_ID_82546GB_QUAD_COPPER:
302 case E1000_DEV_ID_82546GB_QUAD_COPPER_KSP3:
303 hw->mac_type = e1000_82546_rev_3;
304 break;
305 case E1000_DEV_ID_82541EI:
306 case E1000_DEV_ID_82541EI_MOBILE:
307 case E1000_DEV_ID_82541ER_LOM:
308 hw->mac_type = e1000_82541;
309 break;
310 case E1000_DEV_ID_82541ER:
311 case E1000_DEV_ID_82541GI:
312 case E1000_DEV_ID_82541GI_LF:
313 case E1000_DEV_ID_82541GI_MOBILE:
314 hw->mac_type = e1000_82541_rev_2;
315 break;
316 case E1000_DEV_ID_82547EI:
317 case E1000_DEV_ID_82547EI_MOBILE:
318 hw->mac_type = e1000_82547;
319 break;
320 case E1000_DEV_ID_82547GI:
321 hw->mac_type = e1000_82547_rev_2;
322 break;
323 case E1000_DEV_ID_INTEL_CE4100_GBE:
324 hw->mac_type = e1000_ce4100;
325 break;
326 default:
327
328 return -E1000_ERR_MAC_TYPE;
329 }
330
331 switch (hw->mac_type) {
332 case e1000_82541:
333 case e1000_82547:
334 case e1000_82541_rev_2:
335 case e1000_82547_rev_2:
336 hw->asf_firmware_present = true;
337 break;
338 default:
339 break;
340 }
341
342
343
344
345 if (hw->mac_type == e1000_82543)
346 hw->bad_tx_carr_stats_fd = true;
347
348 if (hw->mac_type > e1000_82544)
349 hw->has_smbus = true;
350
351 return E1000_SUCCESS;
352}
353
354
355
356
357
358void e1000_set_media_type(struct e1000_hw *hw)
359{
360 u32 status;
361
362 if (hw->mac_type != e1000_82543) {
363
364 hw->tbi_compatibility_en = false;
365 }
366
367 switch (hw->device_id) {
368 case E1000_DEV_ID_82545GM_SERDES:
369 case E1000_DEV_ID_82546GB_SERDES:
370 hw->media_type = e1000_media_type_internal_serdes;
371 break;
372 default:
373 switch (hw->mac_type) {
374 case e1000_82542_rev2_0:
375 case e1000_82542_rev2_1:
376 hw->media_type = e1000_media_type_fiber;
377 break;
378 case e1000_ce4100:
379 hw->media_type = e1000_media_type_copper;
380 break;
381 default:
382 status = er32(STATUS);
383 if (status & E1000_STATUS_TBIMODE) {
384 hw->media_type = e1000_media_type_fiber;
385
386 hw->tbi_compatibility_en = false;
387 } else {
388 hw->media_type = e1000_media_type_copper;
389 }
390 break;
391 }
392 }
393}
394
395
396
397
398
399
400
401s32 e1000_reset_hw(struct e1000_hw *hw)
402{
403 u32 ctrl;
404 u32 ctrl_ext;
405 u32 icr;
406 u32 manc;
407 u32 led_ctrl;
408 s32 ret_val;
409
410
411 if (hw->mac_type == e1000_82542_rev2_0) {
412 e_dbg("Disabling MWI on 82542 rev 2.0\n");
413 e1000_pci_clear_mwi(hw);
414 }
415
416
417 e_dbg("Masking off all interrupts\n");
418 ew32(IMC, 0xffffffff);
419
420
421
422
423
424 ew32(RCTL, 0);
425 ew32(TCTL, E1000_TCTL_PSP);
426 E1000_WRITE_FLUSH();
427
428
429 hw->tbi_compatibility_on = false;
430
431
432
433
434 msleep(10);
435
436 ctrl = er32(CTRL);
437
438
439 if ((hw->mac_type == e1000_82541) || (hw->mac_type == e1000_82547)) {
440 ew32(CTRL, (ctrl | E1000_CTRL_PHY_RST));
441 E1000_WRITE_FLUSH();
442 msleep(5);
443 }
444
445
446
447
448
449
450 e_dbg("Issuing a global reset to MAC\n");
451
452 switch (hw->mac_type) {
453 case e1000_82544:
454 case e1000_82540:
455 case e1000_82545:
456 case e1000_82546:
457 case e1000_82541:
458 case e1000_82541_rev_2:
459
460
461
462 E1000_WRITE_REG_IO(hw, CTRL, (ctrl | E1000_CTRL_RST));
463 break;
464 case e1000_82545_rev_3:
465 case e1000_82546_rev_3:
466
467 ew32(CTRL_DUP, (ctrl | E1000_CTRL_RST));
468 break;
469 case e1000_ce4100:
470 default:
471 ew32(CTRL, (ctrl | E1000_CTRL_RST));
472 break;
473 }
474
475
476
477
478
479 switch (hw->mac_type) {
480 case e1000_82542_rev2_0:
481 case e1000_82542_rev2_1:
482 case e1000_82543:
483 case e1000_82544:
484
485 udelay(10);
486 ctrl_ext = er32(CTRL_EXT);
487 ctrl_ext |= E1000_CTRL_EXT_EE_RST;
488 ew32(CTRL_EXT, ctrl_ext);
489 E1000_WRITE_FLUSH();
490
491 msleep(2);
492 break;
493 case e1000_82541:
494 case e1000_82541_rev_2:
495 case e1000_82547:
496 case e1000_82547_rev_2:
497
498 msleep(20);
499 break;
500 default:
501
502 ret_val = e1000_get_auto_rd_done(hw);
503 if (ret_val)
504 return ret_val;
505 break;
506 }
507
508
509 if (hw->mac_type >= e1000_82540) {
510 manc = er32(MANC);
511 manc &= ~(E1000_MANC_ARP_EN);
512 ew32(MANC, manc);
513 }
514
515 if ((hw->mac_type == e1000_82541) || (hw->mac_type == e1000_82547)) {
516 e1000_phy_init_script(hw);
517
518
519 led_ctrl = er32(LEDCTL);
520 led_ctrl &= IGP_ACTIVITY_LED_MASK;
521 led_ctrl |= (IGP_ACTIVITY_LED_ENABLE | IGP_LED3_MODE);
522 ew32(LEDCTL, led_ctrl);
523 }
524
525
526 e_dbg("Masking off all interrupts\n");
527 ew32(IMC, 0xffffffff);
528
529
530 icr = er32(ICR);
531
532
533 if (hw->mac_type == e1000_82542_rev2_0) {
534 if (hw->pci_cmd_word & PCI_COMMAND_INVALIDATE)
535 e1000_pci_set_mwi(hw);
536 }
537
538 return E1000_SUCCESS;
539}
540
541
542
543
544
545
546
547
548
549
550
551s32 e1000_init_hw(struct e1000_hw *hw)
552{
553 u32 ctrl;
554 u32 i;
555 s32 ret_val;
556 u32 mta_size;
557 u32 ctrl_ext;
558
559
560 ret_val = e1000_id_led_init(hw);
561 if (ret_val) {
562 e_dbg("Error Initializing Identification LED\n");
563 return ret_val;
564 }
565
566
567 e1000_set_media_type(hw);
568
569
570 e_dbg("Initializing the IEEE VLAN\n");
571 if (hw->mac_type < e1000_82545_rev_3)
572 ew32(VET, 0);
573 e1000_clear_vfta(hw);
574
575
576 if (hw->mac_type == e1000_82542_rev2_0) {
577 e_dbg("Disabling MWI on 82542 rev 2.0\n");
578 e1000_pci_clear_mwi(hw);
579 ew32(RCTL, E1000_RCTL_RST);
580 E1000_WRITE_FLUSH();
581 msleep(5);
582 }
583
584
585
586
587 e1000_init_rx_addrs(hw);
588
589
590 if (hw->mac_type == e1000_82542_rev2_0) {
591 ew32(RCTL, 0);
592 E1000_WRITE_FLUSH();
593 msleep(1);
594 if (hw->pci_cmd_word & PCI_COMMAND_INVALIDATE)
595 e1000_pci_set_mwi(hw);
596 }
597
598
599 e_dbg("Zeroing the MTA\n");
600 mta_size = E1000_MC_TBL_SIZE;
601 for (i = 0; i < mta_size; i++) {
602 E1000_WRITE_REG_ARRAY(hw, MTA, i, 0);
603
604
605
606 E1000_WRITE_FLUSH();
607 }
608
609
610
611
612
613
614 if (hw->dma_fairness && hw->mac_type <= e1000_82543) {
615 ctrl = er32(CTRL);
616 ew32(CTRL, ctrl | E1000_CTRL_PRIOR);
617 }
618
619 switch (hw->mac_type) {
620 case e1000_82545_rev_3:
621 case e1000_82546_rev_3:
622 break;
623 default:
624
625
626
627 if (hw->bus_type == e1000_bus_type_pcix &&
628 e1000_pcix_get_mmrbc(hw) > 2048)
629 e1000_pcix_set_mmrbc(hw, 2048);
630 break;
631 }
632
633
634 ret_val = e1000_setup_link(hw);
635
636
637 if (hw->mac_type > e1000_82544) {
638 ctrl = er32(TXDCTL);
639 ctrl =
640 (ctrl & ~E1000_TXDCTL_WTHRESH) |
641 E1000_TXDCTL_FULL_TX_DESC_WB;
642 ew32(TXDCTL, ctrl);
643 }
644
645
646
647
648
649
650 e1000_clear_hw_cntrs(hw);
651
652 if (hw->device_id == E1000_DEV_ID_82546GB_QUAD_COPPER ||
653 hw->device_id == E1000_DEV_ID_82546GB_QUAD_COPPER_KSP3) {
654 ctrl_ext = er32(CTRL_EXT);
655
656
657
658 ctrl_ext |= E1000_CTRL_EXT_RO_DIS;
659 ew32(CTRL_EXT, ctrl_ext);
660 }
661
662 return ret_val;
663}
664
665
666
667
668
669static s32 e1000_adjust_serdes_amplitude(struct e1000_hw *hw)
670{
671 u16 eeprom_data;
672 s32 ret_val;
673
674 if (hw->media_type != e1000_media_type_internal_serdes)
675 return E1000_SUCCESS;
676
677 switch (hw->mac_type) {
678 case e1000_82545_rev_3:
679 case e1000_82546_rev_3:
680 break;
681 default:
682 return E1000_SUCCESS;
683 }
684
685 ret_val = e1000_read_eeprom(hw, EEPROM_SERDES_AMPLITUDE, 1,
686 &eeprom_data);
687 if (ret_val)
688 return ret_val;
689
690 if (eeprom_data != EEPROM_RESERVED_WORD) {
691
692 eeprom_data &= EEPROM_SERDES_AMPLITUDE_MASK;
693 ret_val =
694 e1000_write_phy_reg(hw, M88E1000_PHY_EXT_CTRL, eeprom_data);
695 if (ret_val)
696 return ret_val;
697 }
698
699 return E1000_SUCCESS;
700}
701
702
703
704
705
706
707
708
709
710
711
712s32 e1000_setup_link(struct e1000_hw *hw)
713{
714 u32 ctrl_ext;
715 s32 ret_val;
716 u16 eeprom_data;
717
718
719
720
721
722
723
724
725
726 if (hw->fc == E1000_FC_DEFAULT) {
727 ret_val = e1000_read_eeprom(hw, EEPROM_INIT_CONTROL2_REG,
728 1, &eeprom_data);
729 if (ret_val) {
730 e_dbg("EEPROM Read Error\n");
731 return -E1000_ERR_EEPROM;
732 }
733 if ((eeprom_data & EEPROM_WORD0F_PAUSE_MASK) == 0)
734 hw->fc = E1000_FC_NONE;
735 else if ((eeprom_data & EEPROM_WORD0F_PAUSE_MASK) ==
736 EEPROM_WORD0F_ASM_DIR)
737 hw->fc = E1000_FC_TX_PAUSE;
738 else
739 hw->fc = E1000_FC_FULL;
740 }
741
742
743
744
745
746 if (hw->mac_type == e1000_82542_rev2_0)
747 hw->fc &= (~E1000_FC_TX_PAUSE);
748
749 if ((hw->mac_type < e1000_82543) && (hw->report_tx_early == 1))
750 hw->fc &= (~E1000_FC_RX_PAUSE);
751
752 hw->original_fc = hw->fc;
753
754 e_dbg("After fix-ups FlowControl is now = %x\n", hw->fc);
755
756
757
758
759
760
761
762
763 if (hw->mac_type == e1000_82543) {
764 ret_val = e1000_read_eeprom(hw, EEPROM_INIT_CONTROL2_REG,
765 1, &eeprom_data);
766 if (ret_val) {
767 e_dbg("EEPROM Read Error\n");
768 return -E1000_ERR_EEPROM;
769 }
770 ctrl_ext = ((eeprom_data & EEPROM_WORD0F_SWPDIO_EXT) <<
771 SWDPIO__EXT_SHIFT);
772 ew32(CTRL_EXT, ctrl_ext);
773 }
774
775
776 ret_val = (hw->media_type == e1000_media_type_copper) ?
777 e1000_setup_copper_link(hw) : e1000_setup_fiber_serdes_link(hw);
778
779
780
781
782
783
784 e_dbg("Initializing the Flow Control address, type and timer regs\n");
785
786 ew32(FCT, FLOW_CONTROL_TYPE);
787 ew32(FCAH, FLOW_CONTROL_ADDRESS_HIGH);
788 ew32(FCAL, FLOW_CONTROL_ADDRESS_LOW);
789
790 ew32(FCTTV, hw->fc_pause_time);
791
792
793
794
795
796
797
798 if (!(hw->fc & E1000_FC_TX_PAUSE)) {
799 ew32(FCRTL, 0);
800 ew32(FCRTH, 0);
801 } else {
802
803
804
805
806 if (hw->fc_send_xon) {
807 ew32(FCRTL, (hw->fc_low_water | E1000_FCRTL_XONE));
808 ew32(FCRTH, hw->fc_high_water);
809 } else {
810 ew32(FCRTL, hw->fc_low_water);
811 ew32(FCRTH, hw->fc_high_water);
812 }
813 }
814 return ret_val;
815}
816
817
818
819
820
821
822
823
824
825static s32 e1000_setup_fiber_serdes_link(struct e1000_hw *hw)
826{
827 u32 ctrl;
828 u32 status;
829 u32 txcw = 0;
830 u32 i;
831 u32 signal = 0;
832 s32 ret_val;
833
834
835
836
837
838
839
840 ctrl = er32(CTRL);
841 if (hw->media_type == e1000_media_type_fiber)
842 signal = (hw->mac_type > e1000_82544) ? E1000_CTRL_SWDPIN1 : 0;
843
844 ret_val = e1000_adjust_serdes_amplitude(hw);
845 if (ret_val)
846 return ret_val;
847
848
849 ctrl &= ~(E1000_CTRL_LRST);
850
851
852 ret_val = e1000_set_vco_speed(hw);
853 if (ret_val)
854 return ret_val;
855
856 e1000_config_collision_dist(hw);
857
858
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874 switch (hw->fc) {
875 case E1000_FC_NONE:
876
877 txcw = (E1000_TXCW_ANE | E1000_TXCW_FD);
878 break;
879 case E1000_FC_RX_PAUSE:
880
881
882
883
884
885
886
887 txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_PAUSE_MASK);
888 break;
889 case E1000_FC_TX_PAUSE:
890
891
892
893 txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_ASM_DIR);
894 break;
895 case E1000_FC_FULL:
896
897
898
899 txcw = (E1000_TXCW_ANE | E1000_TXCW_FD | E1000_TXCW_PAUSE_MASK);
900 break;
901 default:
902 e_dbg("Flow control param set incorrectly\n");
903 return -E1000_ERR_CONFIG;
904 }
905
906
907
908
909
910
911
912 e_dbg("Auto-negotiation enabled\n");
913
914 ew32(TXCW, txcw);
915 ew32(CTRL, ctrl);
916 E1000_WRITE_FLUSH();
917
918 hw->txcw = txcw;
919 msleep(1);
920
921
922
923
924
925
926
927
928 if (hw->media_type == e1000_media_type_internal_serdes ||
929 (er32(CTRL) & E1000_CTRL_SWDPIN1) == signal) {
930 e_dbg("Looking for Link\n");
931 for (i = 0; i < (LINK_UP_TIMEOUT / 10); i++) {
932 msleep(10);
933 status = er32(STATUS);
934 if (status & E1000_STATUS_LU)
935 break;
936 }
937 if (i == (LINK_UP_TIMEOUT / 10)) {
938 e_dbg("Never got a valid link from auto-neg!!!\n");
939 hw->autoneg_failed = 1;
940
941
942
943
944
945 ret_val = e1000_check_for_link(hw);
946 if (ret_val) {
947 e_dbg("Error while checking for link\n");
948 return ret_val;
949 }
950 hw->autoneg_failed = 0;
951 } else {
952 hw->autoneg_failed = 0;
953 e_dbg("Valid Link Found\n");
954 }
955 } else {
956 e_dbg("No Signal Detected\n");
957 }
958 return E1000_SUCCESS;
959}
960
961
962
963
964
965
966
967static s32 e1000_copper_link_rtl_setup(struct e1000_hw *hw)
968{
969 s32 ret_val;
970
971
972 ret_val = e1000_phy_reset(hw);
973 if (ret_val) {
974 e_dbg("Error Resetting the PHY\n");
975 return ret_val;
976 }
977
978 return E1000_SUCCESS;
979}
980
981static s32 gbe_dhg_phy_setup(struct e1000_hw *hw)
982{
983 s32 ret_val;
984 u32 ctrl_aux;
985
986 switch (hw->phy_type) {
987 case e1000_phy_8211:
988 ret_val = e1000_copper_link_rtl_setup(hw);
989 if (ret_val) {
990 e_dbg("e1000_copper_link_rtl_setup failed!\n");
991 return ret_val;
992 }
993 break;
994 case e1000_phy_8201:
995
996 ctrl_aux = er32(CTL_AUX);
997 ctrl_aux |= E1000_CTL_AUX_RMII;
998 ew32(CTL_AUX, ctrl_aux);
999 E1000_WRITE_FLUSH();
1000
1001
1002 ctrl_aux = er32(CTL_AUX);
1003 ctrl_aux |= 0x4;
1004 ctrl_aux &= ~0x2;
1005 ew32(CTL_AUX, ctrl_aux);
1006 E1000_WRITE_FLUSH();
1007 ret_val = e1000_copper_link_rtl_setup(hw);
1008
1009 if (ret_val) {
1010 e_dbg("e1000_copper_link_rtl_setup failed!\n");
1011 return ret_val;
1012 }
1013 break;
1014 default:
1015 e_dbg("Error Resetting the PHY\n");
1016 return E1000_ERR_PHY_TYPE;
1017 }
1018
1019 return E1000_SUCCESS;
1020}
1021
1022
1023
1024
1025
1026
1027
1028static s32 e1000_copper_link_preconfig(struct e1000_hw *hw)
1029{
1030 u32 ctrl;
1031 s32 ret_val;
1032 u16 phy_data;
1033
1034 ctrl = er32(CTRL);
1035
1036
1037
1038
1039 if (hw->mac_type > e1000_82543) {
1040 ctrl |= E1000_CTRL_SLU;
1041 ctrl &= ~(E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
1042 ew32(CTRL, ctrl);
1043 } else {
1044 ctrl |=
1045 (E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX | E1000_CTRL_SLU);
1046 ew32(CTRL, ctrl);
1047 ret_val = e1000_phy_hw_reset(hw);
1048 if (ret_val)
1049 return ret_val;
1050 }
1051
1052
1053 ret_val = e1000_detect_gig_phy(hw);
1054 if (ret_val) {
1055 e_dbg("Error, did not detect valid phy.\n");
1056 return ret_val;
1057 }
1058 e_dbg("Phy ID = %x\n", hw->phy_id);
1059
1060
1061 ret_val = e1000_set_phy_mode(hw);
1062 if (ret_val)
1063 return ret_val;
1064
1065 if ((hw->mac_type == e1000_82545_rev_3) ||
1066 (hw->mac_type == e1000_82546_rev_3)) {
1067 ret_val =
1068 e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
1069 phy_data |= 0x00000008;
1070 ret_val =
1071 e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
1072 }
1073
1074 if (hw->mac_type <= e1000_82543 ||
1075 hw->mac_type == e1000_82541 || hw->mac_type == e1000_82547 ||
1076 hw->mac_type == e1000_82541_rev_2 ||
1077 hw->mac_type == e1000_82547_rev_2)
1078 hw->phy_reset_disable = false;
1079
1080 return E1000_SUCCESS;
1081}
1082
1083
1084
1085
1086
1087static s32 e1000_copper_link_igp_setup(struct e1000_hw *hw)
1088{
1089 u32 led_ctrl;
1090 s32 ret_val;
1091 u16 phy_data;
1092
1093 if (hw->phy_reset_disable)
1094 return E1000_SUCCESS;
1095
1096 ret_val = e1000_phy_reset(hw);
1097 if (ret_val) {
1098 e_dbg("Error Resetting the PHY\n");
1099 return ret_val;
1100 }
1101
1102
1103 msleep(15);
1104
1105 led_ctrl = er32(LEDCTL);
1106 led_ctrl &= IGP_ACTIVITY_LED_MASK;
1107 led_ctrl |= (IGP_ACTIVITY_LED_ENABLE | IGP_LED3_MODE);
1108 ew32(LEDCTL, led_ctrl);
1109
1110
1111 if (hw->phy_type == e1000_phy_igp) {
1112
1113 ret_val = e1000_set_d3_lplu_state(hw, false);
1114 if (ret_val) {
1115 e_dbg("Error Disabling LPLU D3\n");
1116 return ret_val;
1117 }
1118 }
1119
1120
1121 ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CTRL, &phy_data);
1122 if (ret_val)
1123 return ret_val;
1124
1125 if ((hw->mac_type == e1000_82541) || (hw->mac_type == e1000_82547)) {
1126 hw->dsp_config_state = e1000_dsp_config_disabled;
1127
1128 phy_data &=
1129 ~(IGP01E1000_PSCR_AUTO_MDIX |
1130 IGP01E1000_PSCR_FORCE_MDI_MDIX);
1131 hw->mdix = 1;
1132
1133 } else {
1134 hw->dsp_config_state = e1000_dsp_config_enabled;
1135 phy_data &= ~IGP01E1000_PSCR_AUTO_MDIX;
1136
1137 switch (hw->mdix) {
1138 case 1:
1139 phy_data &= ~IGP01E1000_PSCR_FORCE_MDI_MDIX;
1140 break;
1141 case 2:
1142 phy_data |= IGP01E1000_PSCR_FORCE_MDI_MDIX;
1143 break;
1144 case 0:
1145 default:
1146 phy_data |= IGP01E1000_PSCR_AUTO_MDIX;
1147 break;
1148 }
1149 }
1150 ret_val = e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CTRL, phy_data);
1151 if (ret_val)
1152 return ret_val;
1153
1154
1155 if (hw->autoneg) {
1156 e1000_ms_type phy_ms_setting = hw->master_slave;
1157
1158 if (hw->ffe_config_state == e1000_ffe_config_active)
1159 hw->ffe_config_state = e1000_ffe_config_enabled;
1160
1161 if (hw->dsp_config_state == e1000_dsp_config_activated)
1162 hw->dsp_config_state = e1000_dsp_config_enabled;
1163
1164
1165
1166
1167
1168 if (hw->autoneg_advertised == ADVERTISE_1000_FULL) {
1169
1170 ret_val =
1171 e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
1172 &phy_data);
1173 if (ret_val)
1174 return ret_val;
1175 phy_data &= ~IGP01E1000_PSCFR_SMART_SPEED;
1176 ret_val =
1177 e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
1178 phy_data);
1179 if (ret_val)
1180 return ret_val;
1181
1182 ret_val =
1183 e1000_read_phy_reg(hw, PHY_1000T_CTRL, &phy_data);
1184 if (ret_val)
1185 return ret_val;
1186 phy_data &= ~CR_1000T_MS_ENABLE;
1187 ret_val =
1188 e1000_write_phy_reg(hw, PHY_1000T_CTRL, phy_data);
1189 if (ret_val)
1190 return ret_val;
1191 }
1192
1193 ret_val = e1000_read_phy_reg(hw, PHY_1000T_CTRL, &phy_data);
1194 if (ret_val)
1195 return ret_val;
1196
1197
1198 hw->original_master_slave = (phy_data & CR_1000T_MS_ENABLE) ?
1199 ((phy_data & CR_1000T_MS_VALUE) ?
1200 e1000_ms_force_master :
1201 e1000_ms_force_slave) : e1000_ms_auto;
1202
1203 switch (phy_ms_setting) {
1204 case e1000_ms_force_master:
1205 phy_data |= (CR_1000T_MS_ENABLE | CR_1000T_MS_VALUE);
1206 break;
1207 case e1000_ms_force_slave:
1208 phy_data |= CR_1000T_MS_ENABLE;
1209 phy_data &= ~(CR_1000T_MS_VALUE);
1210 break;
1211 case e1000_ms_auto:
1212 phy_data &= ~CR_1000T_MS_ENABLE;
1213 default:
1214 break;
1215 }
1216 ret_val = e1000_write_phy_reg(hw, PHY_1000T_CTRL, phy_data);
1217 if (ret_val)
1218 return ret_val;
1219 }
1220
1221 return E1000_SUCCESS;
1222}
1223
1224
1225
1226
1227
1228static s32 e1000_copper_link_mgp_setup(struct e1000_hw *hw)
1229{
1230 s32 ret_val;
1231 u16 phy_data;
1232
1233 if (hw->phy_reset_disable)
1234 return E1000_SUCCESS;
1235
1236
1237 ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
1238 if (ret_val)
1239 return ret_val;
1240
1241 phy_data |= M88E1000_PSCR_ASSERT_CRS_ON_TX;
1242
1243
1244
1245
1246
1247
1248
1249
1250 phy_data &= ~M88E1000_PSCR_AUTO_X_MODE;
1251
1252 switch (hw->mdix) {
1253 case 1:
1254 phy_data |= M88E1000_PSCR_MDI_MANUAL_MODE;
1255 break;
1256 case 2:
1257 phy_data |= M88E1000_PSCR_MDIX_MANUAL_MODE;
1258 break;
1259 case 3:
1260 phy_data |= M88E1000_PSCR_AUTO_X_1000T;
1261 break;
1262 case 0:
1263 default:
1264 phy_data |= M88E1000_PSCR_AUTO_X_MODE;
1265 break;
1266 }
1267
1268
1269
1270
1271
1272
1273
1274 phy_data &= ~M88E1000_PSCR_POLARITY_REVERSAL;
1275 if (hw->disable_polarity_correction == 1)
1276 phy_data |= M88E1000_PSCR_POLARITY_REVERSAL;
1277 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
1278 if (ret_val)
1279 return ret_val;
1280
1281 if (hw->phy_revision < M88E1011_I_REV_4) {
1282
1283
1284
1285 ret_val =
1286 e1000_read_phy_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL,
1287 &phy_data);
1288 if (ret_val)
1289 return ret_val;
1290
1291 phy_data |= M88E1000_EPSCR_TX_CLK_25;
1292
1293 if ((hw->phy_revision == E1000_REVISION_2) &&
1294 (hw->phy_id == M88E1111_I_PHY_ID)) {
1295
1296 phy_data &= ~(M88EC018_EPSCR_DOWNSHIFT_COUNTER_MASK);
1297 phy_data |= M88EC018_EPSCR_DOWNSHIFT_COUNTER_5X;
1298 ret_val = e1000_write_phy_reg(hw,
1299 M88E1000_EXT_PHY_SPEC_CTRL,
1300 phy_data);
1301 if (ret_val)
1302 return ret_val;
1303 } else {
1304
1305 phy_data &= ~(M88E1000_EPSCR_MASTER_DOWNSHIFT_MASK |
1306 M88E1000_EPSCR_SLAVE_DOWNSHIFT_MASK);
1307 phy_data |= (M88E1000_EPSCR_MASTER_DOWNSHIFT_1X |
1308 M88E1000_EPSCR_SLAVE_DOWNSHIFT_1X);
1309 ret_val = e1000_write_phy_reg(hw,
1310 M88E1000_EXT_PHY_SPEC_CTRL,
1311 phy_data);
1312 if (ret_val)
1313 return ret_val;
1314 }
1315 }
1316
1317
1318 ret_val = e1000_phy_reset(hw);
1319 if (ret_val) {
1320 e_dbg("Error Resetting the PHY\n");
1321 return ret_val;
1322 }
1323
1324 return E1000_SUCCESS;
1325}
1326
1327
1328
1329
1330
1331
1332
1333
1334static s32 e1000_copper_link_autoneg(struct e1000_hw *hw)
1335{
1336 s32 ret_val;
1337 u16 phy_data;
1338
1339
1340
1341
1342 hw->autoneg_advertised &= AUTONEG_ADVERTISE_SPEED_DEFAULT;
1343
1344
1345
1346
1347 if (hw->autoneg_advertised == 0)
1348 hw->autoneg_advertised = AUTONEG_ADVERTISE_SPEED_DEFAULT;
1349
1350
1351 if (hw->phy_type == e1000_phy_8201)
1352 hw->autoneg_advertised &= AUTONEG_ADVERTISE_10_100_ALL;
1353
1354 e_dbg("Reconfiguring auto-neg advertisement params\n");
1355 ret_val = e1000_phy_setup_autoneg(hw);
1356 if (ret_val) {
1357 e_dbg("Error Setting up Auto-Negotiation\n");
1358 return ret_val;
1359 }
1360 e_dbg("Restarting Auto-Neg\n");
1361
1362
1363
1364
1365 ret_val = e1000_read_phy_reg(hw, PHY_CTRL, &phy_data);
1366 if (ret_val)
1367 return ret_val;
1368
1369 phy_data |= (MII_CR_AUTO_NEG_EN | MII_CR_RESTART_AUTO_NEG);
1370 ret_val = e1000_write_phy_reg(hw, PHY_CTRL, phy_data);
1371 if (ret_val)
1372 return ret_val;
1373
1374
1375
1376
1377 if (hw->wait_autoneg_complete) {
1378 ret_val = e1000_wait_autoneg(hw);
1379 if (ret_val) {
1380 e_dbg
1381 ("Error while waiting for autoneg to complete\n");
1382 return ret_val;
1383 }
1384 }
1385
1386 hw->get_link_status = true;
1387
1388 return E1000_SUCCESS;
1389}
1390
1391
1392
1393
1394
1395
1396
1397
1398
1399
1400
1401
1402
1403
1404static s32 e1000_copper_link_postconfig(struct e1000_hw *hw)
1405{
1406 s32 ret_val;
1407
1408 if ((hw->mac_type >= e1000_82544) && (hw->mac_type != e1000_ce4100)) {
1409 e1000_config_collision_dist(hw);
1410 } else {
1411 ret_val = e1000_config_mac_to_phy(hw);
1412 if (ret_val) {
1413 e_dbg("Error configuring MAC to PHY settings\n");
1414 return ret_val;
1415 }
1416 }
1417 ret_val = e1000_config_fc_after_link_up(hw);
1418 if (ret_val) {
1419 e_dbg("Error Configuring Flow Control\n");
1420 return ret_val;
1421 }
1422
1423
1424 if (hw->phy_type == e1000_phy_igp) {
1425 ret_val = e1000_config_dsp_after_link_change(hw, true);
1426 if (ret_val) {
1427 e_dbg("Error Configuring DSP after link up\n");
1428 return ret_val;
1429 }
1430 }
1431
1432 return E1000_SUCCESS;
1433}
1434
1435
1436
1437
1438
1439
1440
1441static s32 e1000_setup_copper_link(struct e1000_hw *hw)
1442{
1443 s32 ret_val;
1444 u16 i;
1445 u16 phy_data;
1446
1447
1448 ret_val = e1000_copper_link_preconfig(hw);
1449 if (ret_val)
1450 return ret_val;
1451
1452 if (hw->phy_type == e1000_phy_igp) {
1453 ret_val = e1000_copper_link_igp_setup(hw);
1454 if (ret_val)
1455 return ret_val;
1456 } else if (hw->phy_type == e1000_phy_m88) {
1457 ret_val = e1000_copper_link_mgp_setup(hw);
1458 if (ret_val)
1459 return ret_val;
1460 } else {
1461 ret_val = gbe_dhg_phy_setup(hw);
1462 if (ret_val) {
1463 e_dbg("gbe_dhg_phy_setup failed!\n");
1464 return ret_val;
1465 }
1466 }
1467
1468 if (hw->autoneg) {
1469
1470
1471
1472 ret_val = e1000_copper_link_autoneg(hw);
1473 if (ret_val)
1474 return ret_val;
1475 } else {
1476
1477
1478
1479 e_dbg("Forcing speed and duplex\n");
1480 ret_val = e1000_phy_force_speed_duplex(hw);
1481 if (ret_val) {
1482 e_dbg("Error Forcing Speed and Duplex\n");
1483 return ret_val;
1484 }
1485 }
1486
1487
1488
1489
1490 for (i = 0; i < 10; i++) {
1491 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
1492 if (ret_val)
1493 return ret_val;
1494 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
1495 if (ret_val)
1496 return ret_val;
1497
1498 if (phy_data & MII_SR_LINK_STATUS) {
1499
1500 ret_val = e1000_copper_link_postconfig(hw);
1501 if (ret_val)
1502 return ret_val;
1503
1504 e_dbg("Valid link established!!!\n");
1505 return E1000_SUCCESS;
1506 }
1507 udelay(10);
1508 }
1509
1510 e_dbg("Unable to establish link!!!\n");
1511 return E1000_SUCCESS;
1512}
1513
1514
1515
1516
1517
1518
1519
1520s32 e1000_phy_setup_autoneg(struct e1000_hw *hw)
1521{
1522 s32 ret_val;
1523 u16 mii_autoneg_adv_reg;
1524 u16 mii_1000t_ctrl_reg;
1525
1526
1527 ret_val = e1000_read_phy_reg(hw, PHY_AUTONEG_ADV, &mii_autoneg_adv_reg);
1528 if (ret_val)
1529 return ret_val;
1530
1531
1532 ret_val = e1000_read_phy_reg(hw, PHY_1000T_CTRL, &mii_1000t_ctrl_reg);
1533 if (ret_val)
1534 return ret_val;
1535 else if (hw->phy_type == e1000_phy_8201)
1536 mii_1000t_ctrl_reg &= ~REG9_SPEED_MASK;
1537
1538
1539
1540
1541
1542
1543
1544
1545
1546
1547
1548
1549 mii_autoneg_adv_reg &= ~REG4_SPEED_MASK;
1550 mii_1000t_ctrl_reg &= ~REG9_SPEED_MASK;
1551
1552 e_dbg("autoneg_advertised %x\n", hw->autoneg_advertised);
1553
1554
1555 if (hw->autoneg_advertised & ADVERTISE_10_HALF) {
1556 e_dbg("Advertise 10mb Half duplex\n");
1557 mii_autoneg_adv_reg |= NWAY_AR_10T_HD_CAPS;
1558 }
1559
1560
1561 if (hw->autoneg_advertised & ADVERTISE_10_FULL) {
1562 e_dbg("Advertise 10mb Full duplex\n");
1563 mii_autoneg_adv_reg |= NWAY_AR_10T_FD_CAPS;
1564 }
1565
1566
1567 if (hw->autoneg_advertised & ADVERTISE_100_HALF) {
1568 e_dbg("Advertise 100mb Half duplex\n");
1569 mii_autoneg_adv_reg |= NWAY_AR_100TX_HD_CAPS;
1570 }
1571
1572
1573 if (hw->autoneg_advertised & ADVERTISE_100_FULL) {
1574 e_dbg("Advertise 100mb Full duplex\n");
1575 mii_autoneg_adv_reg |= NWAY_AR_100TX_FD_CAPS;
1576 }
1577
1578
1579 if (hw->autoneg_advertised & ADVERTISE_1000_HALF) {
1580 e_dbg
1581 ("Advertise 1000mb Half duplex requested, request denied!\n");
1582 }
1583
1584
1585 if (hw->autoneg_advertised & ADVERTISE_1000_FULL) {
1586 e_dbg("Advertise 1000mb Full duplex\n");
1587 mii_1000t_ctrl_reg |= CR_1000T_FD_CAPS;
1588 }
1589
1590
1591
1592
1593
1594
1595
1596
1597
1598
1599
1600
1601
1602
1603
1604
1605
1606
1607 switch (hw->fc) {
1608 case E1000_FC_NONE:
1609
1610
1611
1612 mii_autoneg_adv_reg &= ~(NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
1613 break;
1614 case E1000_FC_RX_PAUSE:
1615
1616
1617
1618
1619
1620
1621
1622
1623
1624 mii_autoneg_adv_reg |= (NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
1625 break;
1626 case E1000_FC_TX_PAUSE:
1627
1628
1629
1630 mii_autoneg_adv_reg |= NWAY_AR_ASM_DIR;
1631 mii_autoneg_adv_reg &= ~NWAY_AR_PAUSE;
1632 break;
1633 case E1000_FC_FULL:
1634
1635
1636
1637 mii_autoneg_adv_reg |= (NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
1638 break;
1639 default:
1640 e_dbg("Flow control param set incorrectly\n");
1641 return -E1000_ERR_CONFIG;
1642 }
1643
1644 ret_val = e1000_write_phy_reg(hw, PHY_AUTONEG_ADV, mii_autoneg_adv_reg);
1645 if (ret_val)
1646 return ret_val;
1647
1648 e_dbg("Auto-Neg Advertising %x\n", mii_autoneg_adv_reg);
1649
1650 if (hw->phy_type == e1000_phy_8201) {
1651 mii_1000t_ctrl_reg = 0;
1652 } else {
1653 ret_val = e1000_write_phy_reg(hw, PHY_1000T_CTRL,
1654 mii_1000t_ctrl_reg);
1655 if (ret_val)
1656 return ret_val;
1657 }
1658
1659 return E1000_SUCCESS;
1660}
1661
1662
1663
1664
1665
1666
1667
1668static s32 e1000_phy_force_speed_duplex(struct e1000_hw *hw)
1669{
1670 u32 ctrl;
1671 s32 ret_val;
1672 u16 mii_ctrl_reg;
1673 u16 mii_status_reg;
1674 u16 phy_data;
1675 u16 i;
1676
1677
1678 hw->fc = E1000_FC_NONE;
1679
1680 e_dbg("hw->fc = %d\n", hw->fc);
1681
1682
1683 ctrl = er32(CTRL);
1684
1685
1686 ctrl |= (E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
1687 ctrl &= ~(DEVICE_SPEED_MASK);
1688
1689
1690 ctrl &= ~E1000_CTRL_ASDE;
1691
1692
1693 ret_val = e1000_read_phy_reg(hw, PHY_CTRL, &mii_ctrl_reg);
1694 if (ret_val)
1695 return ret_val;
1696
1697
1698
1699 mii_ctrl_reg &= ~MII_CR_AUTO_NEG_EN;
1700
1701
1702 if (hw->forced_speed_duplex == e1000_100_full ||
1703 hw->forced_speed_duplex == e1000_10_full) {
1704
1705
1706
1707 ctrl |= E1000_CTRL_FD;
1708 mii_ctrl_reg |= MII_CR_FULL_DUPLEX;
1709 e_dbg("Full Duplex\n");
1710 } else {
1711
1712
1713
1714 ctrl &= ~E1000_CTRL_FD;
1715 mii_ctrl_reg &= ~MII_CR_FULL_DUPLEX;
1716 e_dbg("Half Duplex\n");
1717 }
1718
1719
1720 if (hw->forced_speed_duplex == e1000_100_full ||
1721 hw->forced_speed_duplex == e1000_100_half) {
1722
1723 ctrl |= E1000_CTRL_SPD_100;
1724 mii_ctrl_reg |= MII_CR_SPEED_100;
1725 mii_ctrl_reg &= ~(MII_CR_SPEED_1000 | MII_CR_SPEED_10);
1726 e_dbg("Forcing 100mb ");
1727 } else {
1728
1729 ctrl &= ~(E1000_CTRL_SPD_1000 | E1000_CTRL_SPD_100);
1730 mii_ctrl_reg |= MII_CR_SPEED_10;
1731 mii_ctrl_reg &= ~(MII_CR_SPEED_1000 | MII_CR_SPEED_100);
1732 e_dbg("Forcing 10mb ");
1733 }
1734
1735 e1000_config_collision_dist(hw);
1736
1737
1738 ew32(CTRL, ctrl);
1739
1740 if (hw->phy_type == e1000_phy_m88) {
1741 ret_val =
1742 e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
1743 if (ret_val)
1744 return ret_val;
1745
1746
1747
1748
1749 phy_data &= ~M88E1000_PSCR_AUTO_X_MODE;
1750 ret_val =
1751 e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
1752 if (ret_val)
1753 return ret_val;
1754
1755 e_dbg("M88E1000 PSCR: %x\n", phy_data);
1756
1757
1758 mii_ctrl_reg |= MII_CR_RESET;
1759
1760
1761 } else {
1762
1763
1764
1765 ret_val =
1766 e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CTRL, &phy_data);
1767 if (ret_val)
1768 return ret_val;
1769
1770 phy_data &= ~IGP01E1000_PSCR_AUTO_MDIX;
1771 phy_data &= ~IGP01E1000_PSCR_FORCE_MDI_MDIX;
1772
1773 ret_val =
1774 e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CTRL, phy_data);
1775 if (ret_val)
1776 return ret_val;
1777 }
1778
1779
1780 ret_val = e1000_write_phy_reg(hw, PHY_CTRL, mii_ctrl_reg);
1781 if (ret_val)
1782 return ret_val;
1783
1784 udelay(1);
1785
1786
1787
1788
1789
1790
1791
1792
1793 if (hw->wait_autoneg_complete) {
1794
1795 e_dbg("Waiting for forced speed/duplex link.\n");
1796 mii_status_reg = 0;
1797
1798
1799 for (i = PHY_FORCE_TIME; i > 0; i--) {
1800
1801
1802
1803 ret_val =
1804 e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
1805 if (ret_val)
1806 return ret_val;
1807
1808 ret_val =
1809 e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
1810 if (ret_val)
1811 return ret_val;
1812
1813 if (mii_status_reg & MII_SR_LINK_STATUS)
1814 break;
1815 msleep(100);
1816 }
1817 if ((i == 0) && (hw->phy_type == e1000_phy_m88)) {
1818
1819
1820
1821 ret_val = e1000_phy_reset_dsp(hw);
1822 if (ret_val) {
1823 e_dbg("Error Resetting PHY DSP\n");
1824 return ret_val;
1825 }
1826 }
1827
1828
1829
1830 for (i = PHY_FORCE_TIME; i > 0; i--) {
1831 if (mii_status_reg & MII_SR_LINK_STATUS)
1832 break;
1833 msleep(100);
1834
1835
1836
1837 ret_val =
1838 e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
1839 if (ret_val)
1840 return ret_val;
1841
1842 ret_val =
1843 e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
1844 if (ret_val)
1845 return ret_val;
1846 }
1847 }
1848
1849 if (hw->phy_type == e1000_phy_m88) {
1850
1851
1852
1853
1854
1855 ret_val =
1856 e1000_read_phy_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL,
1857 &phy_data);
1858 if (ret_val)
1859 return ret_val;
1860
1861 phy_data |= M88E1000_EPSCR_TX_CLK_25;
1862 ret_val =
1863 e1000_write_phy_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL,
1864 phy_data);
1865 if (ret_val)
1866 return ret_val;
1867
1868
1869
1870
1871
1872 ret_val =
1873 e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
1874 if (ret_val)
1875 return ret_val;
1876
1877 phy_data |= M88E1000_PSCR_ASSERT_CRS_ON_TX;
1878 ret_val =
1879 e1000_write_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
1880 if (ret_val)
1881 return ret_val;
1882
1883 if ((hw->mac_type == e1000_82544 ||
1884 hw->mac_type == e1000_82543) &&
1885 (!hw->autoneg) &&
1886 (hw->forced_speed_duplex == e1000_10_full ||
1887 hw->forced_speed_duplex == e1000_10_half)) {
1888 ret_val = e1000_polarity_reversal_workaround(hw);
1889 if (ret_val)
1890 return ret_val;
1891 }
1892 }
1893 return E1000_SUCCESS;
1894}
1895
1896
1897
1898
1899
1900
1901
1902
1903
1904void e1000_config_collision_dist(struct e1000_hw *hw)
1905{
1906 u32 tctl, coll_dist;
1907
1908 if (hw->mac_type < e1000_82543)
1909 coll_dist = E1000_COLLISION_DISTANCE_82542;
1910 else
1911 coll_dist = E1000_COLLISION_DISTANCE;
1912
1913 tctl = er32(TCTL);
1914
1915 tctl &= ~E1000_TCTL_COLD;
1916 tctl |= coll_dist << E1000_COLD_SHIFT;
1917
1918 ew32(TCTL, tctl);
1919 E1000_WRITE_FLUSH();
1920}
1921
1922
1923
1924
1925
1926
1927
1928
1929
1930
1931static s32 e1000_config_mac_to_phy(struct e1000_hw *hw)
1932{
1933 u32 ctrl;
1934 s32 ret_val;
1935 u16 phy_data;
1936
1937
1938
1939
1940 if ((hw->mac_type >= e1000_82544) && (hw->mac_type != e1000_ce4100))
1941 return E1000_SUCCESS;
1942
1943
1944
1945
1946 ctrl = er32(CTRL);
1947 ctrl |= (E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
1948 ctrl &= ~(E1000_CTRL_SPD_SEL | E1000_CTRL_ILOS);
1949
1950 switch (hw->phy_type) {
1951 case e1000_phy_8201:
1952 ret_val = e1000_read_phy_reg(hw, PHY_CTRL, &phy_data);
1953 if (ret_val)
1954 return ret_val;
1955
1956 if (phy_data & RTL_PHY_CTRL_FD)
1957 ctrl |= E1000_CTRL_FD;
1958 else
1959 ctrl &= ~E1000_CTRL_FD;
1960
1961 if (phy_data & RTL_PHY_CTRL_SPD_100)
1962 ctrl |= E1000_CTRL_SPD_100;
1963 else
1964 ctrl |= E1000_CTRL_SPD_10;
1965
1966 e1000_config_collision_dist(hw);
1967 break;
1968 default:
1969
1970
1971
1972 ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS,
1973 &phy_data);
1974 if (ret_val)
1975 return ret_val;
1976
1977 if (phy_data & M88E1000_PSSR_DPLX)
1978 ctrl |= E1000_CTRL_FD;
1979 else
1980 ctrl &= ~E1000_CTRL_FD;
1981
1982 e1000_config_collision_dist(hw);
1983
1984
1985
1986
1987 if ((phy_data & M88E1000_PSSR_SPEED) == M88E1000_PSSR_1000MBS)
1988 ctrl |= E1000_CTRL_SPD_1000;
1989 else if ((phy_data & M88E1000_PSSR_SPEED) ==
1990 M88E1000_PSSR_100MBS)
1991 ctrl |= E1000_CTRL_SPD_100;
1992 }
1993
1994
1995 ew32(CTRL, ctrl);
1996 return E1000_SUCCESS;
1997}
1998
1999
2000
2001
2002
2003
2004
2005
2006
2007
2008
2009
2010s32 e1000_force_mac_fc(struct e1000_hw *hw)
2011{
2012 u32 ctrl;
2013
2014
2015 ctrl = er32(CTRL);
2016
2017
2018
2019
2020
2021
2022
2023
2024
2025
2026
2027
2028
2029
2030
2031
2032
2033
2034
2035 switch (hw->fc) {
2036 case E1000_FC_NONE:
2037 ctrl &= (~(E1000_CTRL_TFCE | E1000_CTRL_RFCE));
2038 break;
2039 case E1000_FC_RX_PAUSE:
2040 ctrl &= (~E1000_CTRL_TFCE);
2041 ctrl |= E1000_CTRL_RFCE;
2042 break;
2043 case E1000_FC_TX_PAUSE:
2044 ctrl &= (~E1000_CTRL_RFCE);
2045 ctrl |= E1000_CTRL_TFCE;
2046 break;
2047 case E1000_FC_FULL:
2048 ctrl |= (E1000_CTRL_TFCE | E1000_CTRL_RFCE);
2049 break;
2050 default:
2051 e_dbg("Flow control param set incorrectly\n");
2052 return -E1000_ERR_CONFIG;
2053 }
2054
2055
2056 if (hw->mac_type == e1000_82542_rev2_0)
2057 ctrl &= (~E1000_CTRL_TFCE);
2058
2059 ew32(CTRL, ctrl);
2060 return E1000_SUCCESS;
2061}
2062
2063
2064
2065
2066
2067
2068
2069
2070
2071
2072
2073
2074static s32 e1000_config_fc_after_link_up(struct e1000_hw *hw)
2075{
2076 s32 ret_val;
2077 u16 mii_status_reg;
2078 u16 mii_nway_adv_reg;
2079 u16 mii_nway_lp_ability_reg;
2080 u16 speed;
2081 u16 duplex;
2082
2083
2084
2085
2086
2087 if (((hw->media_type == e1000_media_type_fiber) &&
2088 (hw->autoneg_failed)) ||
2089 ((hw->media_type == e1000_media_type_internal_serdes) &&
2090 (hw->autoneg_failed)) ||
2091 ((hw->media_type == e1000_media_type_copper) &&
2092 (!hw->autoneg))) {
2093 ret_val = e1000_force_mac_fc(hw);
2094 if (ret_val) {
2095 e_dbg("Error forcing flow control settings\n");
2096 return ret_val;
2097 }
2098 }
2099
2100
2101
2102
2103
2104
2105 if ((hw->media_type == e1000_media_type_copper) && hw->autoneg) {
2106
2107
2108
2109
2110 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
2111 if (ret_val)
2112 return ret_val;
2113 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
2114 if (ret_val)
2115 return ret_val;
2116
2117 if (mii_status_reg & MII_SR_AUTONEG_COMPLETE) {
2118
2119
2120
2121
2122
2123
2124 ret_val = e1000_read_phy_reg(hw, PHY_AUTONEG_ADV,
2125 &mii_nway_adv_reg);
2126 if (ret_val)
2127 return ret_val;
2128 ret_val = e1000_read_phy_reg(hw, PHY_LP_ABILITY,
2129 &mii_nway_lp_ability_reg);
2130 if (ret_val)
2131 return ret_val;
2132
2133
2134
2135
2136
2137
2138
2139
2140
2141
2142
2143
2144
2145
2146
2147
2148
2149
2150
2151
2152
2153
2154
2155
2156
2157
2158
2159
2160
2161
2162
2163
2164
2165
2166
2167
2168 if ((mii_nway_adv_reg & NWAY_AR_PAUSE) &&
2169 (mii_nway_lp_ability_reg & NWAY_LPAR_PAUSE)) {
2170
2171
2172
2173
2174
2175
2176
2177 if (hw->original_fc == E1000_FC_FULL) {
2178 hw->fc = E1000_FC_FULL;
2179 e_dbg("Flow Control = FULL.\n");
2180 } else {
2181 hw->fc = E1000_FC_RX_PAUSE;
2182 e_dbg
2183 ("Flow Control = RX PAUSE frames only.\n");
2184 }
2185 }
2186
2187
2188
2189
2190
2191
2192
2193
2194 else if (!(mii_nway_adv_reg & NWAY_AR_PAUSE) &&
2195 (mii_nway_adv_reg & NWAY_AR_ASM_DIR) &&
2196 (mii_nway_lp_ability_reg & NWAY_LPAR_PAUSE) &&
2197 (mii_nway_lp_ability_reg & NWAY_LPAR_ASM_DIR)) {
2198 hw->fc = E1000_FC_TX_PAUSE;
2199 e_dbg
2200 ("Flow Control = TX PAUSE frames only.\n");
2201 }
2202
2203
2204
2205
2206
2207
2208
2209
2210 else if ((mii_nway_adv_reg & NWAY_AR_PAUSE) &&
2211 (mii_nway_adv_reg & NWAY_AR_ASM_DIR) &&
2212 !(mii_nway_lp_ability_reg & NWAY_LPAR_PAUSE) &&
2213 (mii_nway_lp_ability_reg & NWAY_LPAR_ASM_DIR)) {
2214 hw->fc = E1000_FC_RX_PAUSE;
2215 e_dbg
2216 ("Flow Control = RX PAUSE frames only.\n");
2217 }
2218
2219
2220
2221
2222
2223
2224
2225
2226
2227
2228
2229
2230
2231
2232
2233
2234
2235
2236
2237
2238
2239
2240 else if ((hw->original_fc == E1000_FC_NONE ||
2241 hw->original_fc == E1000_FC_TX_PAUSE) ||
2242 hw->fc_strict_ieee) {
2243 hw->fc = E1000_FC_NONE;
2244 e_dbg("Flow Control = NONE.\n");
2245 } else {
2246 hw->fc = E1000_FC_RX_PAUSE;
2247 e_dbg
2248 ("Flow Control = RX PAUSE frames only.\n");
2249 }
2250
2251
2252
2253
2254
2255 ret_val =
2256 e1000_get_speed_and_duplex(hw, &speed, &duplex);
2257 if (ret_val) {
2258 e_dbg
2259 ("Error getting link speed and duplex\n");
2260 return ret_val;
2261 }
2262
2263 if (duplex == HALF_DUPLEX)
2264 hw->fc = E1000_FC_NONE;
2265
2266
2267
2268
2269 ret_val = e1000_force_mac_fc(hw);
2270 if (ret_val) {
2271 e_dbg
2272 ("Error forcing flow control settings\n");
2273 return ret_val;
2274 }
2275 } else {
2276 e_dbg
2277 ("Copper PHY and Auto Neg has not completed.\n");
2278 }
2279 }
2280 return E1000_SUCCESS;
2281}
2282
2283
2284
2285
2286
2287
2288
2289
2290static s32 e1000_check_for_serdes_link_generic(struct e1000_hw *hw)
2291{
2292 u32 rxcw;
2293 u32 ctrl;
2294 u32 status;
2295 s32 ret_val = E1000_SUCCESS;
2296
2297 ctrl = er32(CTRL);
2298 status = er32(STATUS);
2299 rxcw = er32(RXCW);
2300
2301
2302
2303
2304
2305
2306
2307
2308 if ((!(status & E1000_STATUS_LU)) && (!(rxcw & E1000_RXCW_C))) {
2309 if (hw->autoneg_failed == 0) {
2310 hw->autoneg_failed = 1;
2311 goto out;
2312 }
2313 e_dbg("NOT RXing /C/, disable AutoNeg and force link.\n");
2314
2315
2316 ew32(TXCW, (hw->txcw & ~E1000_TXCW_ANE));
2317
2318
2319 ctrl = er32(CTRL);
2320 ctrl |= (E1000_CTRL_SLU | E1000_CTRL_FD);
2321 ew32(CTRL, ctrl);
2322
2323
2324 ret_val = e1000_config_fc_after_link_up(hw);
2325 if (ret_val) {
2326 e_dbg("Error configuring flow control\n");
2327 goto out;
2328 }
2329 } else if ((ctrl & E1000_CTRL_SLU) && (rxcw & E1000_RXCW_C)) {
2330
2331
2332
2333
2334
2335 e_dbg("RXing /C/, enable AutoNeg and stop forcing link.\n");
2336 ew32(TXCW, hw->txcw);
2337 ew32(CTRL, (ctrl & ~E1000_CTRL_SLU));
2338
2339 hw->serdes_has_link = true;
2340 } else if (!(E1000_TXCW_ANE & er32(TXCW))) {
2341
2342
2343
2344
2345
2346 udelay(10);
2347 rxcw = er32(RXCW);
2348 if (rxcw & E1000_RXCW_SYNCH) {
2349 if (!(rxcw & E1000_RXCW_IV)) {
2350 hw->serdes_has_link = true;
2351 e_dbg("SERDES: Link up - forced.\n");
2352 }
2353 } else {
2354 hw->serdes_has_link = false;
2355 e_dbg("SERDES: Link down - force failed.\n");
2356 }
2357 }
2358
2359 if (E1000_TXCW_ANE & er32(TXCW)) {
2360 status = er32(STATUS);
2361 if (status & E1000_STATUS_LU) {
2362
2363 udelay(10);
2364 rxcw = er32(RXCW);
2365 if (rxcw & E1000_RXCW_SYNCH) {
2366 if (!(rxcw & E1000_RXCW_IV)) {
2367 hw->serdes_has_link = true;
2368 e_dbg("SERDES: Link up - autoneg "
2369 "completed successfully.\n");
2370 } else {
2371 hw->serdes_has_link = false;
2372 e_dbg("SERDES: Link down - invalid"
2373 "codewords detected in autoneg.\n");
2374 }
2375 } else {
2376 hw->serdes_has_link = false;
2377 e_dbg("SERDES: Link down - no sync.\n");
2378 }
2379 } else {
2380 hw->serdes_has_link = false;
2381 e_dbg("SERDES: Link down - autoneg failed\n");
2382 }
2383 }
2384
2385 out:
2386 return ret_val;
2387}
2388
2389
2390
2391
2392
2393
2394
2395
2396s32 e1000_check_for_link(struct e1000_hw *hw)
2397{
2398 u32 rxcw = 0;
2399 u32 ctrl;
2400 u32 status;
2401 u32 rctl;
2402 u32 icr;
2403 u32 signal = 0;
2404 s32 ret_val;
2405 u16 phy_data;
2406
2407 ctrl = er32(CTRL);
2408 status = er32(STATUS);
2409
2410
2411
2412
2413
2414 if ((hw->media_type == e1000_media_type_fiber) ||
2415 (hw->media_type == e1000_media_type_internal_serdes)) {
2416 rxcw = er32(RXCW);
2417
2418 if (hw->media_type == e1000_media_type_fiber) {
2419 signal =
2420 (hw->mac_type >
2421 e1000_82544) ? E1000_CTRL_SWDPIN1 : 0;
2422 if (status & E1000_STATUS_LU)
2423 hw->get_link_status = false;
2424 }
2425 }
2426
2427
2428
2429
2430
2431
2432
2433 if ((hw->media_type == e1000_media_type_copper) && hw->get_link_status) {
2434
2435
2436
2437
2438
2439 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
2440 if (ret_val)
2441 return ret_val;
2442 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
2443 if (ret_val)
2444 return ret_val;
2445
2446 if (phy_data & MII_SR_LINK_STATUS) {
2447 hw->get_link_status = false;
2448
2449
2450
2451 e1000_check_downshift(hw);
2452
2453
2454
2455
2456
2457
2458
2459
2460
2461
2462 if ((hw->mac_type == e1000_82544 ||
2463 hw->mac_type == e1000_82543) &&
2464 (!hw->autoneg) &&
2465 (hw->forced_speed_duplex == e1000_10_full ||
2466 hw->forced_speed_duplex == e1000_10_half)) {
2467 ew32(IMC, 0xffffffff);
2468 ret_val =
2469 e1000_polarity_reversal_workaround(hw);
2470 icr = er32(ICR);
2471 ew32(ICS, (icr & ~E1000_ICS_LSC));
2472 ew32(IMS, IMS_ENABLE_MASK);
2473 }
2474
2475 } else {
2476
2477 e1000_config_dsp_after_link_change(hw, false);
2478 return 0;
2479 }
2480
2481
2482
2483
2484 if (!hw->autoneg)
2485 return -E1000_ERR_CONFIG;
2486
2487
2488 e1000_config_dsp_after_link_change(hw, true);
2489
2490
2491
2492
2493
2494
2495
2496
2497
2498 if ((hw->mac_type >= e1000_82544) &&
2499 (hw->mac_type != e1000_ce4100))
2500 e1000_config_collision_dist(hw);
2501 else {
2502 ret_val = e1000_config_mac_to_phy(hw);
2503 if (ret_val) {
2504 e_dbg
2505 ("Error configuring MAC to PHY settings\n");
2506 return ret_val;
2507 }
2508 }
2509
2510
2511
2512
2513
2514
2515 ret_val = e1000_config_fc_after_link_up(hw);
2516 if (ret_val) {
2517 e_dbg("Error configuring flow control\n");
2518 return ret_val;
2519 }
2520
2521
2522
2523
2524
2525
2526
2527
2528
2529 if (hw->tbi_compatibility_en) {
2530 u16 speed, duplex;
2531
2532 ret_val =
2533 e1000_get_speed_and_duplex(hw, &speed, &duplex);
2534
2535 if (ret_val) {
2536 e_dbg
2537 ("Error getting link speed and duplex\n");
2538 return ret_val;
2539 }
2540 if (speed != SPEED_1000) {
2541
2542
2543
2544 if (hw->tbi_compatibility_on) {
2545
2546
2547
2548 rctl = er32(RCTL);
2549 rctl &= ~E1000_RCTL_SBP;
2550 ew32(RCTL, rctl);
2551 hw->tbi_compatibility_on = false;
2552 }
2553 } else {
2554
2555
2556
2557
2558
2559
2560 if (!hw->tbi_compatibility_on) {
2561 hw->tbi_compatibility_on = true;
2562 rctl = er32(RCTL);
2563 rctl |= E1000_RCTL_SBP;
2564 ew32(RCTL, rctl);
2565 }
2566 }
2567 }
2568 }
2569
2570 if ((hw->media_type == e1000_media_type_fiber) ||
2571 (hw->media_type == e1000_media_type_internal_serdes))
2572 e1000_check_for_serdes_link_generic(hw);
2573
2574 return E1000_SUCCESS;
2575}
2576
2577
2578
2579
2580
2581
2582
2583
2584
2585s32 e1000_get_speed_and_duplex(struct e1000_hw *hw, u16 *speed, u16 *duplex)
2586{
2587 u32 status;
2588 s32 ret_val;
2589 u16 phy_data;
2590
2591 if (hw->mac_type >= e1000_82543) {
2592 status = er32(STATUS);
2593 if (status & E1000_STATUS_SPEED_1000) {
2594 *speed = SPEED_1000;
2595 e_dbg("1000 Mbs, ");
2596 } else if (status & E1000_STATUS_SPEED_100) {
2597 *speed = SPEED_100;
2598 e_dbg("100 Mbs, ");
2599 } else {
2600 *speed = SPEED_10;
2601 e_dbg("10 Mbs, ");
2602 }
2603
2604 if (status & E1000_STATUS_FD) {
2605 *duplex = FULL_DUPLEX;
2606 e_dbg("Full Duplex\n");
2607 } else {
2608 *duplex = HALF_DUPLEX;
2609 e_dbg(" Half Duplex\n");
2610 }
2611 } else {
2612 e_dbg("1000 Mbs, Full Duplex\n");
2613 *speed = SPEED_1000;
2614 *duplex = FULL_DUPLEX;
2615 }
2616
2617
2618
2619
2620
2621 if (hw->phy_type == e1000_phy_igp && hw->speed_downgraded) {
2622 ret_val = e1000_read_phy_reg(hw, PHY_AUTONEG_EXP, &phy_data);
2623 if (ret_val)
2624 return ret_val;
2625
2626 if (!(phy_data & NWAY_ER_LP_NWAY_CAPS))
2627 *duplex = HALF_DUPLEX;
2628 else {
2629 ret_val =
2630 e1000_read_phy_reg(hw, PHY_LP_ABILITY, &phy_data);
2631 if (ret_val)
2632 return ret_val;
2633 if ((*speed == SPEED_100 &&
2634 !(phy_data & NWAY_LPAR_100TX_FD_CAPS)) ||
2635 (*speed == SPEED_10 &&
2636 !(phy_data & NWAY_LPAR_10T_FD_CAPS)))
2637 *duplex = HALF_DUPLEX;
2638 }
2639 }
2640
2641 return E1000_SUCCESS;
2642}
2643
2644
2645
2646
2647
2648
2649
2650static s32 e1000_wait_autoneg(struct e1000_hw *hw)
2651{
2652 s32 ret_val;
2653 u16 i;
2654 u16 phy_data;
2655
2656 e_dbg("Waiting for Auto-Neg to complete.\n");
2657
2658
2659 for (i = PHY_AUTO_NEG_TIME; i > 0; i--) {
2660
2661
2662
2663 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
2664 if (ret_val)
2665 return ret_val;
2666 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
2667 if (ret_val)
2668 return ret_val;
2669 if (phy_data & MII_SR_AUTONEG_COMPLETE)
2670 return E1000_SUCCESS;
2671
2672 msleep(100);
2673 }
2674 return E1000_SUCCESS;
2675}
2676
2677
2678
2679
2680
2681
2682static void e1000_raise_mdi_clk(struct e1000_hw *hw, u32 *ctrl)
2683{
2684
2685
2686
2687 ew32(CTRL, (*ctrl | E1000_CTRL_MDC));
2688 E1000_WRITE_FLUSH();
2689 udelay(10);
2690}
2691
2692
2693
2694
2695
2696
2697static void e1000_lower_mdi_clk(struct e1000_hw *hw, u32 *ctrl)
2698{
2699
2700
2701
2702 ew32(CTRL, (*ctrl & ~E1000_CTRL_MDC));
2703 E1000_WRITE_FLUSH();
2704 udelay(10);
2705}
2706
2707
2708
2709
2710
2711
2712
2713
2714
2715static void e1000_shift_out_mdi_bits(struct e1000_hw *hw, u32 data, u16 count)
2716{
2717 u32 ctrl;
2718 u32 mask;
2719
2720
2721
2722
2723
2724 mask = 0x01;
2725 mask <<= (count - 1);
2726
2727 ctrl = er32(CTRL);
2728
2729
2730 ctrl |= (E1000_CTRL_MDIO_DIR | E1000_CTRL_MDC_DIR);
2731
2732 while (mask) {
2733
2734
2735
2736
2737
2738 if (data & mask)
2739 ctrl |= E1000_CTRL_MDIO;
2740 else
2741 ctrl &= ~E1000_CTRL_MDIO;
2742
2743 ew32(CTRL, ctrl);
2744 E1000_WRITE_FLUSH();
2745
2746 udelay(10);
2747
2748 e1000_raise_mdi_clk(hw, &ctrl);
2749 e1000_lower_mdi_clk(hw, &ctrl);
2750
2751 mask = mask >> 1;
2752 }
2753}
2754
2755
2756
2757
2758
2759
2760
2761static u16 e1000_shift_in_mdi_bits(struct e1000_hw *hw)
2762{
2763 u32 ctrl;
2764 u16 data = 0;
2765 u8 i;
2766
2767
2768
2769
2770
2771
2772
2773
2774 ctrl = er32(CTRL);
2775
2776
2777
2778
2779 ctrl &= ~E1000_CTRL_MDIO_DIR;
2780 ctrl &= ~E1000_CTRL_MDIO;
2781
2782 ew32(CTRL, ctrl);
2783 E1000_WRITE_FLUSH();
2784
2785
2786
2787
2788
2789 e1000_raise_mdi_clk(hw, &ctrl);
2790 e1000_lower_mdi_clk(hw, &ctrl);
2791
2792 for (data = 0, i = 0; i < 16; i++) {
2793 data = data << 1;
2794 e1000_raise_mdi_clk(hw, &ctrl);
2795 ctrl = er32(CTRL);
2796
2797 if (ctrl & E1000_CTRL_MDIO)
2798 data |= 1;
2799 e1000_lower_mdi_clk(hw, &ctrl);
2800 }
2801
2802 e1000_raise_mdi_clk(hw, &ctrl);
2803 e1000_lower_mdi_clk(hw, &ctrl);
2804
2805 return data;
2806}
2807
2808
2809
2810
2811
2812
2813
2814
2815
2816
2817s32 e1000_read_phy_reg(struct e1000_hw *hw, u32 reg_addr, u16 *phy_data)
2818{
2819 u32 ret_val;
2820 unsigned long flags;
2821
2822 spin_lock_irqsave(&e1000_phy_lock, flags);
2823
2824 if ((hw->phy_type == e1000_phy_igp) &&
2825 (reg_addr > MAX_PHY_MULTI_PAGE_REG)) {
2826 ret_val = e1000_write_phy_reg_ex(hw, IGP01E1000_PHY_PAGE_SELECT,
2827 (u16) reg_addr);
2828 if (ret_val)
2829 goto out;
2830 }
2831
2832 ret_val = e1000_read_phy_reg_ex(hw, MAX_PHY_REG_ADDRESS & reg_addr,
2833 phy_data);
2834out:
2835 spin_unlock_irqrestore(&e1000_phy_lock, flags);
2836
2837 return ret_val;
2838}
2839
2840static s32 e1000_read_phy_reg_ex(struct e1000_hw *hw, u32 reg_addr,
2841 u16 *phy_data)
2842{
2843 u32 i;
2844 u32 mdic = 0;
2845 const u32 phy_addr = (hw->mac_type == e1000_ce4100) ? hw->phy_addr : 1;
2846
2847 if (reg_addr > MAX_PHY_REG_ADDRESS) {
2848 e_dbg("PHY Address %d is out of range\n", reg_addr);
2849 return -E1000_ERR_PARAM;
2850 }
2851
2852 if (hw->mac_type > e1000_82543) {
2853
2854
2855
2856
2857 if (hw->mac_type == e1000_ce4100) {
2858 mdic = ((reg_addr << E1000_MDIC_REG_SHIFT) |
2859 (phy_addr << E1000_MDIC_PHY_SHIFT) |
2860 (INTEL_CE_GBE_MDIC_OP_READ) |
2861 (INTEL_CE_GBE_MDIC_GO));
2862
2863 writel(mdic, E1000_MDIO_CMD);
2864
2865
2866
2867
2868 for (i = 0; i < 64; i++) {
2869 udelay(50);
2870 mdic = readl(E1000_MDIO_CMD);
2871 if (!(mdic & INTEL_CE_GBE_MDIC_GO))
2872 break;
2873 }
2874
2875 if (mdic & INTEL_CE_GBE_MDIC_GO) {
2876 e_dbg("MDI Read did not complete\n");
2877 return -E1000_ERR_PHY;
2878 }
2879
2880 mdic = readl(E1000_MDIO_STS);
2881 if (mdic & INTEL_CE_GBE_MDIC_READ_ERROR) {
2882 e_dbg("MDI Read Error\n");
2883 return -E1000_ERR_PHY;
2884 }
2885 *phy_data = (u16)mdic;
2886 } else {
2887 mdic = ((reg_addr << E1000_MDIC_REG_SHIFT) |
2888 (phy_addr << E1000_MDIC_PHY_SHIFT) |
2889 (E1000_MDIC_OP_READ));
2890
2891 ew32(MDIC, mdic);
2892
2893
2894
2895
2896 for (i = 0; i < 64; i++) {
2897 udelay(50);
2898 mdic = er32(MDIC);
2899 if (mdic & E1000_MDIC_READY)
2900 break;
2901 }
2902 if (!(mdic & E1000_MDIC_READY)) {
2903 e_dbg("MDI Read did not complete\n");
2904 return -E1000_ERR_PHY;
2905 }
2906 if (mdic & E1000_MDIC_ERROR) {
2907 e_dbg("MDI Error\n");
2908 return -E1000_ERR_PHY;
2909 }
2910 *phy_data = (u16)mdic;
2911 }
2912 } else {
2913
2914
2915
2916
2917 e1000_shift_out_mdi_bits(hw, PHY_PREAMBLE, PHY_PREAMBLE_SIZE);
2918
2919
2920
2921
2922
2923
2924
2925
2926
2927
2928
2929
2930
2931 mdic = ((reg_addr) | (phy_addr << 5) |
2932 (PHY_OP_READ << 10) | (PHY_SOF << 12));
2933
2934 e1000_shift_out_mdi_bits(hw, mdic, 14);
2935
2936
2937
2938
2939
2940 *phy_data = e1000_shift_in_mdi_bits(hw);
2941 }
2942 return E1000_SUCCESS;
2943}
2944
2945
2946
2947
2948
2949
2950
2951
2952
2953
2954s32 e1000_write_phy_reg(struct e1000_hw *hw, u32 reg_addr, u16 phy_data)
2955{
2956 u32 ret_val;
2957 unsigned long flags;
2958
2959 spin_lock_irqsave(&e1000_phy_lock, flags);
2960
2961 if ((hw->phy_type == e1000_phy_igp) &&
2962 (reg_addr > MAX_PHY_MULTI_PAGE_REG)) {
2963 ret_val = e1000_write_phy_reg_ex(hw, IGP01E1000_PHY_PAGE_SELECT,
2964 (u16)reg_addr);
2965 if (ret_val) {
2966 spin_unlock_irqrestore(&e1000_phy_lock, flags);
2967 return ret_val;
2968 }
2969 }
2970
2971 ret_val = e1000_write_phy_reg_ex(hw, MAX_PHY_REG_ADDRESS & reg_addr,
2972 phy_data);
2973 spin_unlock_irqrestore(&e1000_phy_lock, flags);
2974
2975 return ret_val;
2976}
2977
2978static s32 e1000_write_phy_reg_ex(struct e1000_hw *hw, u32 reg_addr,
2979 u16 phy_data)
2980{
2981 u32 i;
2982 u32 mdic = 0;
2983 const u32 phy_addr = (hw->mac_type == e1000_ce4100) ? hw->phy_addr : 1;
2984
2985 if (reg_addr > MAX_PHY_REG_ADDRESS) {
2986 e_dbg("PHY Address %d is out of range\n", reg_addr);
2987 return -E1000_ERR_PARAM;
2988 }
2989
2990 if (hw->mac_type > e1000_82543) {
2991
2992
2993
2994
2995
2996 if (hw->mac_type == e1000_ce4100) {
2997 mdic = (((u32)phy_data) |
2998 (reg_addr << E1000_MDIC_REG_SHIFT) |
2999 (phy_addr << E1000_MDIC_PHY_SHIFT) |
3000 (INTEL_CE_GBE_MDIC_OP_WRITE) |
3001 (INTEL_CE_GBE_MDIC_GO));
3002
3003 writel(mdic, E1000_MDIO_CMD);
3004
3005
3006
3007
3008 for (i = 0; i < 640; i++) {
3009 udelay(5);
3010 mdic = readl(E1000_MDIO_CMD);
3011 if (!(mdic & INTEL_CE_GBE_MDIC_GO))
3012 break;
3013 }
3014 if (mdic & INTEL_CE_GBE_MDIC_GO) {
3015 e_dbg("MDI Write did not complete\n");
3016 return -E1000_ERR_PHY;
3017 }
3018 } else {
3019 mdic = (((u32)phy_data) |
3020 (reg_addr << E1000_MDIC_REG_SHIFT) |
3021 (phy_addr << E1000_MDIC_PHY_SHIFT) |
3022 (E1000_MDIC_OP_WRITE));
3023
3024 ew32(MDIC, mdic);
3025
3026
3027
3028
3029 for (i = 0; i < 641; i++) {
3030 udelay(5);
3031 mdic = er32(MDIC);
3032 if (mdic & E1000_MDIC_READY)
3033 break;
3034 }
3035 if (!(mdic & E1000_MDIC_READY)) {
3036 e_dbg("MDI Write did not complete\n");
3037 return -E1000_ERR_PHY;
3038 }
3039 }
3040 } else {
3041
3042
3043
3044
3045
3046 e1000_shift_out_mdi_bits(hw, PHY_PREAMBLE, PHY_PREAMBLE_SIZE);
3047
3048
3049
3050
3051
3052
3053
3054 mdic = ((PHY_TURNAROUND) | (reg_addr << 2) | (phy_addr << 7) |
3055 (PHY_OP_WRITE << 12) | (PHY_SOF << 14));
3056 mdic <<= 16;
3057 mdic |= (u32)phy_data;
3058
3059 e1000_shift_out_mdi_bits(hw, mdic, 32);
3060 }
3061
3062 return E1000_SUCCESS;
3063}
3064
3065
3066
3067
3068
3069
3070
3071s32 e1000_phy_hw_reset(struct e1000_hw *hw)
3072{
3073 u32 ctrl, ctrl_ext;
3074 u32 led_ctrl;
3075
3076 e_dbg("Resetting Phy...\n");
3077
3078 if (hw->mac_type > e1000_82543) {
3079
3080
3081
3082
3083
3084 ctrl = er32(CTRL);
3085 ew32(CTRL, ctrl | E1000_CTRL_PHY_RST);
3086 E1000_WRITE_FLUSH();
3087
3088 msleep(10);
3089
3090 ew32(CTRL, ctrl);
3091 E1000_WRITE_FLUSH();
3092
3093 } else {
3094
3095
3096
3097
3098 ctrl_ext = er32(CTRL_EXT);
3099 ctrl_ext |= E1000_CTRL_EXT_SDP4_DIR;
3100 ctrl_ext &= ~E1000_CTRL_EXT_SDP4_DATA;
3101 ew32(CTRL_EXT, ctrl_ext);
3102 E1000_WRITE_FLUSH();
3103 msleep(10);
3104 ctrl_ext |= E1000_CTRL_EXT_SDP4_DATA;
3105 ew32(CTRL_EXT, ctrl_ext);
3106 E1000_WRITE_FLUSH();
3107 }
3108 udelay(150);
3109
3110 if ((hw->mac_type == e1000_82541) || (hw->mac_type == e1000_82547)) {
3111
3112 led_ctrl = er32(LEDCTL);
3113 led_ctrl &= IGP_ACTIVITY_LED_MASK;
3114 led_ctrl |= (IGP_ACTIVITY_LED_ENABLE | IGP_LED3_MODE);
3115 ew32(LEDCTL, led_ctrl);
3116 }
3117
3118
3119 return e1000_get_phy_cfg_done(hw);
3120}
3121
3122
3123
3124
3125
3126
3127
3128
3129s32 e1000_phy_reset(struct e1000_hw *hw)
3130{
3131 s32 ret_val;
3132 u16 phy_data;
3133
3134 switch (hw->phy_type) {
3135 case e1000_phy_igp:
3136 ret_val = e1000_phy_hw_reset(hw);
3137 if (ret_val)
3138 return ret_val;
3139 break;
3140 default:
3141 ret_val = e1000_read_phy_reg(hw, PHY_CTRL, &phy_data);
3142 if (ret_val)
3143 return ret_val;
3144
3145 phy_data |= MII_CR_RESET;
3146 ret_val = e1000_write_phy_reg(hw, PHY_CTRL, phy_data);
3147 if (ret_val)
3148 return ret_val;
3149
3150 udelay(1);
3151 break;
3152 }
3153
3154 if (hw->phy_type == e1000_phy_igp)
3155 e1000_phy_init_script(hw);
3156
3157 return E1000_SUCCESS;
3158}
3159
3160
3161
3162
3163
3164
3165
3166static s32 e1000_detect_gig_phy(struct e1000_hw *hw)
3167{
3168 s32 phy_init_status, ret_val;
3169 u16 phy_id_high, phy_id_low;
3170 bool match = false;
3171
3172 if (hw->phy_id != 0)
3173 return E1000_SUCCESS;
3174
3175
3176 ret_val = e1000_read_phy_reg(hw, PHY_ID1, &phy_id_high);
3177 if (ret_val)
3178 return ret_val;
3179
3180 hw->phy_id = (u32)(phy_id_high << 16);
3181 udelay(20);
3182 ret_val = e1000_read_phy_reg(hw, PHY_ID2, &phy_id_low);
3183 if (ret_val)
3184 return ret_val;
3185
3186 hw->phy_id |= (u32)(phy_id_low & PHY_REVISION_MASK);
3187 hw->phy_revision = (u32)phy_id_low & ~PHY_REVISION_MASK;
3188
3189 switch (hw->mac_type) {
3190 case e1000_82543:
3191 if (hw->phy_id == M88E1000_E_PHY_ID)
3192 match = true;
3193 break;
3194 case e1000_82544:
3195 if (hw->phy_id == M88E1000_I_PHY_ID)
3196 match = true;
3197 break;
3198 case e1000_82540:
3199 case e1000_82545:
3200 case e1000_82545_rev_3:
3201 case e1000_82546:
3202 case e1000_82546_rev_3:
3203 if (hw->phy_id == M88E1011_I_PHY_ID)
3204 match = true;
3205 break;
3206 case e1000_ce4100:
3207 if ((hw->phy_id == RTL8211B_PHY_ID) ||
3208 (hw->phy_id == RTL8201N_PHY_ID) ||
3209 (hw->phy_id == M88E1118_E_PHY_ID))
3210 match = true;
3211 break;
3212 case e1000_82541:
3213 case e1000_82541_rev_2:
3214 case e1000_82547:
3215 case e1000_82547_rev_2:
3216 if (hw->phy_id == IGP01E1000_I_PHY_ID)
3217 match = true;
3218 break;
3219 default:
3220 e_dbg("Invalid MAC type %d\n", hw->mac_type);
3221 return -E1000_ERR_CONFIG;
3222 }
3223 phy_init_status = e1000_set_phy_type(hw);
3224
3225 if ((match) && (phy_init_status == E1000_SUCCESS)) {
3226 e_dbg("PHY ID 0x%X detected\n", hw->phy_id);
3227 return E1000_SUCCESS;
3228 }
3229 e_dbg("Invalid PHY ID 0x%X\n", hw->phy_id);
3230 return -E1000_ERR_PHY;
3231}
3232
3233
3234
3235
3236
3237
3238
3239static s32 e1000_phy_reset_dsp(struct e1000_hw *hw)
3240{
3241 s32 ret_val;
3242
3243 do {
3244 ret_val = e1000_write_phy_reg(hw, 29, 0x001d);
3245 if (ret_val)
3246 break;
3247 ret_val = e1000_write_phy_reg(hw, 30, 0x00c1);
3248 if (ret_val)
3249 break;
3250 ret_val = e1000_write_phy_reg(hw, 30, 0x0000);
3251 if (ret_val)
3252 break;
3253 ret_val = E1000_SUCCESS;
3254 } while (0);
3255
3256 return ret_val;
3257}
3258
3259
3260
3261
3262
3263
3264
3265
3266static s32 e1000_phy_igp_get_info(struct e1000_hw *hw,
3267 struct e1000_phy_info *phy_info)
3268{
3269 s32 ret_val;
3270 u16 phy_data, min_length, max_length, average;
3271 e1000_rev_polarity polarity;
3272
3273
3274
3275
3276 phy_info->downshift = (e1000_downshift) hw->speed_downgraded;
3277
3278
3279 phy_info->extended_10bt_distance = e1000_10bt_ext_dist_enable_normal;
3280
3281
3282 phy_info->polarity_correction = e1000_polarity_reversal_enabled;
3283
3284
3285 ret_val = e1000_check_polarity(hw, &polarity);
3286 if (ret_val)
3287 return ret_val;
3288
3289 phy_info->cable_polarity = polarity;
3290
3291 ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_STATUS, &phy_data);
3292 if (ret_val)
3293 return ret_val;
3294
3295 phy_info->mdix_mode =
3296 (e1000_auto_x_mode) ((phy_data & IGP01E1000_PSSR_MDIX) >>
3297 IGP01E1000_PSSR_MDIX_SHIFT);
3298
3299 if ((phy_data & IGP01E1000_PSSR_SPEED_MASK) ==
3300 IGP01E1000_PSSR_SPEED_1000MBPS) {
3301
3302
3303
3304 ret_val = e1000_read_phy_reg(hw, PHY_1000T_STATUS, &phy_data);
3305 if (ret_val)
3306 return ret_val;
3307
3308 phy_info->local_rx = ((phy_data & SR_1000T_LOCAL_RX_STATUS) >>
3309 SR_1000T_LOCAL_RX_STATUS_SHIFT) ?
3310 e1000_1000t_rx_status_ok : e1000_1000t_rx_status_not_ok;
3311 phy_info->remote_rx = ((phy_data & SR_1000T_REMOTE_RX_STATUS) >>
3312 SR_1000T_REMOTE_RX_STATUS_SHIFT) ?
3313 e1000_1000t_rx_status_ok : e1000_1000t_rx_status_not_ok;
3314
3315
3316 ret_val = e1000_get_cable_length(hw, &min_length, &max_length);
3317 if (ret_val)
3318 return ret_val;
3319
3320
3321 average = (max_length + min_length) / 2;
3322
3323 if (average <= e1000_igp_cable_length_50)
3324 phy_info->cable_length = e1000_cable_length_50;
3325 else if (average <= e1000_igp_cable_length_80)
3326 phy_info->cable_length = e1000_cable_length_50_80;
3327 else if (average <= e1000_igp_cable_length_110)
3328 phy_info->cable_length = e1000_cable_length_80_110;
3329 else if (average <= e1000_igp_cable_length_140)
3330 phy_info->cable_length = e1000_cable_length_110_140;
3331 else
3332 phy_info->cable_length = e1000_cable_length_140;
3333 }
3334
3335 return E1000_SUCCESS;
3336}
3337
3338
3339
3340
3341
3342
3343
3344
3345static s32 e1000_phy_m88_get_info(struct e1000_hw *hw,
3346 struct e1000_phy_info *phy_info)
3347{
3348 s32 ret_val;
3349 u16 phy_data;
3350 e1000_rev_polarity polarity;
3351
3352
3353
3354
3355 phy_info->downshift = (e1000_downshift) hw->speed_downgraded;
3356
3357 ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
3358 if (ret_val)
3359 return ret_val;
3360
3361 phy_info->extended_10bt_distance =
3362 ((phy_data & M88E1000_PSCR_10BT_EXT_DIST_ENABLE) >>
3363 M88E1000_PSCR_10BT_EXT_DIST_ENABLE_SHIFT) ?
3364 e1000_10bt_ext_dist_enable_lower :
3365 e1000_10bt_ext_dist_enable_normal;
3366
3367 phy_info->polarity_correction =
3368 ((phy_data & M88E1000_PSCR_POLARITY_REVERSAL) >>
3369 M88E1000_PSCR_POLARITY_REVERSAL_SHIFT) ?
3370 e1000_polarity_reversal_disabled : e1000_polarity_reversal_enabled;
3371
3372
3373 ret_val = e1000_check_polarity(hw, &polarity);
3374 if (ret_val)
3375 return ret_val;
3376 phy_info->cable_polarity = polarity;
3377
3378 ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS, &phy_data);
3379 if (ret_val)
3380 return ret_val;
3381
3382 phy_info->mdix_mode =
3383 (e1000_auto_x_mode) ((phy_data & M88E1000_PSSR_MDIX) >>
3384 M88E1000_PSSR_MDIX_SHIFT);
3385
3386 if ((phy_data & M88E1000_PSSR_SPEED) == M88E1000_PSSR_1000MBS) {
3387
3388
3389
3390 phy_info->cable_length =
3391 (e1000_cable_length) ((phy_data &
3392 M88E1000_PSSR_CABLE_LENGTH) >>
3393 M88E1000_PSSR_CABLE_LENGTH_SHIFT);
3394
3395 ret_val = e1000_read_phy_reg(hw, PHY_1000T_STATUS, &phy_data);
3396 if (ret_val)
3397 return ret_val;
3398
3399 phy_info->local_rx = ((phy_data & SR_1000T_LOCAL_RX_STATUS) >>
3400 SR_1000T_LOCAL_RX_STATUS_SHIFT) ?
3401 e1000_1000t_rx_status_ok : e1000_1000t_rx_status_not_ok;
3402 phy_info->remote_rx = ((phy_data & SR_1000T_REMOTE_RX_STATUS) >>
3403 SR_1000T_REMOTE_RX_STATUS_SHIFT) ?
3404 e1000_1000t_rx_status_ok : e1000_1000t_rx_status_not_ok;
3405 }
3406
3407 return E1000_SUCCESS;
3408}
3409
3410
3411
3412
3413
3414
3415
3416
3417s32 e1000_phy_get_info(struct e1000_hw *hw, struct e1000_phy_info *phy_info)
3418{
3419 s32 ret_val;
3420 u16 phy_data;
3421
3422 phy_info->cable_length = e1000_cable_length_undefined;
3423 phy_info->extended_10bt_distance = e1000_10bt_ext_dist_enable_undefined;
3424 phy_info->cable_polarity = e1000_rev_polarity_undefined;
3425 phy_info->downshift = e1000_downshift_undefined;
3426 phy_info->polarity_correction = e1000_polarity_reversal_undefined;
3427 phy_info->mdix_mode = e1000_auto_x_mode_undefined;
3428 phy_info->local_rx = e1000_1000t_rx_status_undefined;
3429 phy_info->remote_rx = e1000_1000t_rx_status_undefined;
3430
3431 if (hw->media_type != e1000_media_type_copper) {
3432 e_dbg("PHY info is only valid for copper media\n");
3433 return -E1000_ERR_CONFIG;
3434 }
3435
3436 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
3437 if (ret_val)
3438 return ret_val;
3439
3440 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &phy_data);
3441 if (ret_val)
3442 return ret_val;
3443
3444 if ((phy_data & MII_SR_LINK_STATUS) != MII_SR_LINK_STATUS) {
3445 e_dbg("PHY info is only valid if link is up\n");
3446 return -E1000_ERR_CONFIG;
3447 }
3448
3449 if (hw->phy_type == e1000_phy_igp)
3450 return e1000_phy_igp_get_info(hw, phy_info);
3451 else if ((hw->phy_type == e1000_phy_8211) ||
3452 (hw->phy_type == e1000_phy_8201))
3453 return E1000_SUCCESS;
3454 else
3455 return e1000_phy_m88_get_info(hw, phy_info);
3456}
3457
3458s32 e1000_validate_mdi_setting(struct e1000_hw *hw)
3459{
3460 if (!hw->autoneg && (hw->mdix == 0 || hw->mdix == 3)) {
3461 e_dbg("Invalid MDI setting detected\n");
3462 hw->mdix = 1;
3463 return -E1000_ERR_CONFIG;
3464 }
3465 return E1000_SUCCESS;
3466}
3467
3468
3469
3470
3471
3472
3473
3474
3475s32 e1000_init_eeprom_params(struct e1000_hw *hw)
3476{
3477 struct e1000_eeprom_info *eeprom = &hw->eeprom;
3478 u32 eecd = er32(EECD);
3479 s32 ret_val = E1000_SUCCESS;
3480 u16 eeprom_size;
3481
3482 switch (hw->mac_type) {
3483 case e1000_82542_rev2_0:
3484 case e1000_82542_rev2_1:
3485 case e1000_82543:
3486 case e1000_82544:
3487 eeprom->type = e1000_eeprom_microwire;
3488 eeprom->word_size = 64;
3489 eeprom->opcode_bits = 3;
3490 eeprom->address_bits = 6;
3491 eeprom->delay_usec = 50;
3492 break;
3493 case e1000_82540:
3494 case e1000_82545:
3495 case e1000_82545_rev_3:
3496 case e1000_82546:
3497 case e1000_82546_rev_3:
3498 eeprom->type = e1000_eeprom_microwire;
3499 eeprom->opcode_bits = 3;
3500 eeprom->delay_usec = 50;
3501 if (eecd & E1000_EECD_SIZE) {
3502 eeprom->word_size = 256;
3503 eeprom->address_bits = 8;
3504 } else {
3505 eeprom->word_size = 64;
3506 eeprom->address_bits = 6;
3507 }
3508 break;
3509 case e1000_82541:
3510 case e1000_82541_rev_2:
3511 case e1000_82547:
3512 case e1000_82547_rev_2:
3513 if (eecd & E1000_EECD_TYPE) {
3514 eeprom->type = e1000_eeprom_spi;
3515 eeprom->opcode_bits = 8;
3516 eeprom->delay_usec = 1;
3517 if (eecd & E1000_EECD_ADDR_BITS) {
3518 eeprom->page_size = 32;
3519 eeprom->address_bits = 16;
3520 } else {
3521 eeprom->page_size = 8;
3522 eeprom->address_bits = 8;
3523 }
3524 } else {
3525 eeprom->type = e1000_eeprom_microwire;
3526 eeprom->opcode_bits = 3;
3527 eeprom->delay_usec = 50;
3528 if (eecd & E1000_EECD_ADDR_BITS) {
3529 eeprom->word_size = 256;
3530 eeprom->address_bits = 8;
3531 } else {
3532 eeprom->word_size = 64;
3533 eeprom->address_bits = 6;
3534 }
3535 }
3536 break;
3537 default:
3538 break;
3539 }
3540
3541 if (eeprom->type == e1000_eeprom_spi) {
3542
3543
3544
3545
3546 eeprom->word_size = 64;
3547 ret_val = e1000_read_eeprom(hw, EEPROM_CFG, 1, &eeprom_size);
3548 if (ret_val)
3549 return ret_val;
3550 eeprom_size =
3551 (eeprom_size & EEPROM_SIZE_MASK) >> EEPROM_SIZE_SHIFT;
3552
3553
3554
3555
3556 if (eeprom_size)
3557 eeprom_size++;
3558
3559 eeprom->word_size = 1 << (eeprom_size + EEPROM_WORD_SIZE_SHIFT);
3560 }
3561 return ret_val;
3562}
3563
3564
3565
3566
3567
3568
3569static void e1000_raise_ee_clk(struct e1000_hw *hw, u32 *eecd)
3570{
3571
3572
3573
3574 *eecd = *eecd | E1000_EECD_SK;
3575 ew32(EECD, *eecd);
3576 E1000_WRITE_FLUSH();
3577 udelay(hw->eeprom.delay_usec);
3578}
3579
3580
3581
3582
3583
3584
3585static void e1000_lower_ee_clk(struct e1000_hw *hw, u32 *eecd)
3586{
3587
3588
3589
3590 *eecd = *eecd & ~E1000_EECD_SK;
3591 ew32(EECD, *eecd);
3592 E1000_WRITE_FLUSH();
3593 udelay(hw->eeprom.delay_usec);
3594}
3595
3596
3597
3598
3599
3600
3601
3602static void e1000_shift_out_ee_bits(struct e1000_hw *hw, u16 data, u16 count)
3603{
3604 struct e1000_eeprom_info *eeprom = &hw->eeprom;
3605 u32 eecd;
3606 u32 mask;
3607
3608
3609
3610
3611
3612 mask = 0x01 << (count - 1);
3613 eecd = er32(EECD);
3614 if (eeprom->type == e1000_eeprom_microwire)
3615 eecd &= ~E1000_EECD_DO;
3616 else if (eeprom->type == e1000_eeprom_spi)
3617 eecd |= E1000_EECD_DO;
3618
3619 do {
3620
3621
3622
3623
3624
3625
3626 eecd &= ~E1000_EECD_DI;
3627
3628 if (data & mask)
3629 eecd |= E1000_EECD_DI;
3630
3631 ew32(EECD, eecd);
3632 E1000_WRITE_FLUSH();
3633
3634 udelay(eeprom->delay_usec);
3635
3636 e1000_raise_ee_clk(hw, &eecd);
3637 e1000_lower_ee_clk(hw, &eecd);
3638
3639 mask = mask >> 1;
3640
3641 } while (mask);
3642
3643
3644 eecd &= ~E1000_EECD_DI;
3645 ew32(EECD, eecd);
3646}
3647
3648
3649
3650
3651
3652
3653static u16 e1000_shift_in_ee_bits(struct e1000_hw *hw, u16 count)
3654{
3655 u32 eecd;
3656 u32 i;
3657 u16 data;
3658
3659
3660
3661
3662
3663
3664
3665
3666 eecd = er32(EECD);
3667
3668 eecd &= ~(E1000_EECD_DO | E1000_EECD_DI);
3669 data = 0;
3670
3671 for (i = 0; i < count; i++) {
3672 data = data << 1;
3673 e1000_raise_ee_clk(hw, &eecd);
3674
3675 eecd = er32(EECD);
3676
3677 eecd &= ~(E1000_EECD_DI);
3678 if (eecd & E1000_EECD_DO)
3679 data |= 1;
3680
3681 e1000_lower_ee_clk(hw, &eecd);
3682 }
3683
3684 return data;
3685}
3686
3687
3688
3689
3690
3691
3692
3693
3694static s32 e1000_acquire_eeprom(struct e1000_hw *hw)
3695{
3696 struct e1000_eeprom_info *eeprom = &hw->eeprom;
3697 u32 eecd, i = 0;
3698
3699 eecd = er32(EECD);
3700
3701
3702 if (hw->mac_type > e1000_82544) {
3703 eecd |= E1000_EECD_REQ;
3704 ew32(EECD, eecd);
3705 eecd = er32(EECD);
3706 while ((!(eecd & E1000_EECD_GNT)) &&
3707 (i < E1000_EEPROM_GRANT_ATTEMPTS)) {
3708 i++;
3709 udelay(5);
3710 eecd = er32(EECD);
3711 }
3712 if (!(eecd & E1000_EECD_GNT)) {
3713 eecd &= ~E1000_EECD_REQ;
3714 ew32(EECD, eecd);
3715 e_dbg("Could not acquire EEPROM grant\n");
3716 return -E1000_ERR_EEPROM;
3717 }
3718 }
3719
3720
3721
3722 if (eeprom->type == e1000_eeprom_microwire) {
3723
3724 eecd &= ~(E1000_EECD_DI | E1000_EECD_SK);
3725 ew32(EECD, eecd);
3726
3727
3728 eecd |= E1000_EECD_CS;
3729 ew32(EECD, eecd);
3730 } else if (eeprom->type == e1000_eeprom_spi) {
3731
3732 eecd &= ~(E1000_EECD_CS | E1000_EECD_SK);
3733 ew32(EECD, eecd);
3734 E1000_WRITE_FLUSH();
3735 udelay(1);
3736 }
3737
3738 return E1000_SUCCESS;
3739}
3740
3741
3742
3743
3744
3745static void e1000_standby_eeprom(struct e1000_hw *hw)
3746{
3747 struct e1000_eeprom_info *eeprom = &hw->eeprom;
3748 u32 eecd;
3749
3750 eecd = er32(EECD);
3751
3752 if (eeprom->type == e1000_eeprom_microwire) {
3753 eecd &= ~(E1000_EECD_CS | E1000_EECD_SK);
3754 ew32(EECD, eecd);
3755 E1000_WRITE_FLUSH();
3756 udelay(eeprom->delay_usec);
3757
3758
3759 eecd |= E1000_EECD_SK;
3760 ew32(EECD, eecd);
3761 E1000_WRITE_FLUSH();
3762 udelay(eeprom->delay_usec);
3763
3764
3765 eecd |= E1000_EECD_CS;
3766 ew32(EECD, eecd);
3767 E1000_WRITE_FLUSH();
3768 udelay(eeprom->delay_usec);
3769
3770
3771 eecd &= ~E1000_EECD_SK;
3772 ew32(EECD, eecd);
3773 E1000_WRITE_FLUSH();
3774 udelay(eeprom->delay_usec);
3775 } else if (eeprom->type == e1000_eeprom_spi) {
3776
3777 eecd |= E1000_EECD_CS;
3778 ew32(EECD, eecd);
3779 E1000_WRITE_FLUSH();
3780 udelay(eeprom->delay_usec);
3781 eecd &= ~E1000_EECD_CS;
3782 ew32(EECD, eecd);
3783 E1000_WRITE_FLUSH();
3784 udelay(eeprom->delay_usec);
3785 }
3786}
3787
3788
3789
3790
3791
3792
3793
3794static void e1000_release_eeprom(struct e1000_hw *hw)
3795{
3796 u32 eecd;
3797
3798 eecd = er32(EECD);
3799
3800 if (hw->eeprom.type == e1000_eeprom_spi) {
3801 eecd |= E1000_EECD_CS;
3802 eecd &= ~E1000_EECD_SK;
3803
3804 ew32(EECD, eecd);
3805 E1000_WRITE_FLUSH();
3806
3807 udelay(hw->eeprom.delay_usec);
3808 } else if (hw->eeprom.type == e1000_eeprom_microwire) {
3809
3810
3811
3812 eecd &= ~(E1000_EECD_CS | E1000_EECD_DI);
3813
3814 ew32(EECD, eecd);
3815
3816
3817 eecd |= E1000_EECD_SK;
3818 ew32(EECD, eecd);
3819 E1000_WRITE_FLUSH();
3820 udelay(hw->eeprom.delay_usec);
3821
3822
3823 eecd &= ~E1000_EECD_SK;
3824 ew32(EECD, eecd);
3825 E1000_WRITE_FLUSH();
3826 udelay(hw->eeprom.delay_usec);
3827 }
3828
3829
3830 if (hw->mac_type > e1000_82544) {
3831 eecd &= ~E1000_EECD_REQ;
3832 ew32(EECD, eecd);
3833 }
3834}
3835
3836
3837
3838
3839
3840static s32 e1000_spi_eeprom_ready(struct e1000_hw *hw)
3841{
3842 u16 retry_count = 0;
3843 u8 spi_stat_reg;
3844
3845
3846
3847
3848
3849
3850 retry_count = 0;
3851 do {
3852 e1000_shift_out_ee_bits(hw, EEPROM_RDSR_OPCODE_SPI,
3853 hw->eeprom.opcode_bits);
3854 spi_stat_reg = (u8)e1000_shift_in_ee_bits(hw, 8);
3855 if (!(spi_stat_reg & EEPROM_STATUS_RDY_SPI))
3856 break;
3857
3858 udelay(5);
3859 retry_count += 5;
3860
3861 e1000_standby_eeprom(hw);
3862 } while (retry_count < EEPROM_MAX_RETRY_SPI);
3863
3864
3865
3866
3867 if (retry_count >= EEPROM_MAX_RETRY_SPI) {
3868 e_dbg("SPI EEPROM Status error\n");
3869 return -E1000_ERR_EEPROM;
3870 }
3871
3872 return E1000_SUCCESS;
3873}
3874
3875
3876
3877
3878
3879
3880
3881
3882s32 e1000_read_eeprom(struct e1000_hw *hw, u16 offset, u16 words, u16 *data)
3883{
3884 s32 ret;
3885
3886 mutex_lock(&e1000_eeprom_lock);
3887 ret = e1000_do_read_eeprom(hw, offset, words, data);
3888 mutex_unlock(&e1000_eeprom_lock);
3889 return ret;
3890}
3891
3892static s32 e1000_do_read_eeprom(struct e1000_hw *hw, u16 offset, u16 words,
3893 u16 *data)
3894{
3895 struct e1000_eeprom_info *eeprom = &hw->eeprom;
3896 u32 i = 0;
3897
3898 if (hw->mac_type == e1000_ce4100) {
3899 GBE_CONFIG_FLASH_READ(GBE_CONFIG_BASE_VIRT, offset, words,
3900 data);
3901 return E1000_SUCCESS;
3902 }
3903
3904
3905
3906
3907 if ((offset >= eeprom->word_size) ||
3908 (words > eeprom->word_size - offset) ||
3909 (words == 0)) {
3910 e_dbg("\"words\" parameter out of bounds. Words = %d,"
3911 "size = %d\n", offset, eeprom->word_size);
3912 return -E1000_ERR_EEPROM;
3913 }
3914
3915
3916
3917
3918
3919
3920 if (e1000_acquire_eeprom(hw) != E1000_SUCCESS)
3921 return -E1000_ERR_EEPROM;
3922
3923
3924
3925
3926 if (eeprom->type == e1000_eeprom_spi) {
3927 u16 word_in;
3928 u8 read_opcode = EEPROM_READ_OPCODE_SPI;
3929
3930 if (e1000_spi_eeprom_ready(hw)) {
3931 e1000_release_eeprom(hw);
3932 return -E1000_ERR_EEPROM;
3933 }
3934
3935 e1000_standby_eeprom(hw);
3936
3937
3938
3939
3940 if ((eeprom->address_bits == 8) && (offset >= 128))
3941 read_opcode |= EEPROM_A8_OPCODE_SPI;
3942
3943
3944 e1000_shift_out_ee_bits(hw, read_opcode, eeprom->opcode_bits);
3945 e1000_shift_out_ee_bits(hw, (u16)(offset * 2),
3946 eeprom->address_bits);
3947
3948
3949
3950
3951
3952
3953
3954
3955 for (i = 0; i < words; i++) {
3956 word_in = e1000_shift_in_ee_bits(hw, 16);
3957 data[i] = (word_in >> 8) | (word_in << 8);
3958 }
3959 } else if (eeprom->type == e1000_eeprom_microwire) {
3960 for (i = 0; i < words; i++) {
3961
3962 e1000_shift_out_ee_bits(hw,
3963 EEPROM_READ_OPCODE_MICROWIRE,
3964 eeprom->opcode_bits);
3965 e1000_shift_out_ee_bits(hw, (u16)(offset + i),
3966 eeprom->address_bits);
3967
3968
3969
3970
3971 data[i] = e1000_shift_in_ee_bits(hw, 16);
3972 e1000_standby_eeprom(hw);
3973 cond_resched();
3974 }
3975 }
3976
3977
3978 e1000_release_eeprom(hw);
3979
3980 return E1000_SUCCESS;
3981}
3982
3983
3984
3985
3986
3987
3988
3989
3990
3991s32 e1000_validate_eeprom_checksum(struct e1000_hw *hw)
3992{
3993 u16 checksum = 0;
3994 u16 i, eeprom_data;
3995
3996 for (i = 0; i < (EEPROM_CHECKSUM_REG + 1); i++) {
3997 if (e1000_read_eeprom(hw, i, 1, &eeprom_data) < 0) {
3998 e_dbg("EEPROM Read Error\n");
3999 return -E1000_ERR_EEPROM;
4000 }
4001 checksum += eeprom_data;
4002 }
4003
4004#ifdef CONFIG_PARISC
4005
4006 if ((hw->subsystem_vendor_id == 0x103C) && (eeprom_data == 0x16d6))
4007 return E1000_SUCCESS;
4008
4009#endif
4010 if (checksum == (u16)EEPROM_SUM)
4011 return E1000_SUCCESS;
4012 else {
4013 e_dbg("EEPROM Checksum Invalid\n");
4014 return -E1000_ERR_EEPROM;
4015 }
4016}
4017
4018
4019
4020
4021
4022
4023
4024
4025s32 e1000_update_eeprom_checksum(struct e1000_hw *hw)
4026{
4027 u16 checksum = 0;
4028 u16 i, eeprom_data;
4029
4030 for (i = 0; i < EEPROM_CHECKSUM_REG; i++) {
4031 if (e1000_read_eeprom(hw, i, 1, &eeprom_data) < 0) {
4032 e_dbg("EEPROM Read Error\n");
4033 return -E1000_ERR_EEPROM;
4034 }
4035 checksum += eeprom_data;
4036 }
4037 checksum = (u16)EEPROM_SUM - checksum;
4038 if (e1000_write_eeprom(hw, EEPROM_CHECKSUM_REG, 1, &checksum) < 0) {
4039 e_dbg("EEPROM Write Error\n");
4040 return -E1000_ERR_EEPROM;
4041 }
4042 return E1000_SUCCESS;
4043}
4044
4045
4046
4047
4048
4049
4050
4051
4052
4053
4054
4055s32 e1000_write_eeprom(struct e1000_hw *hw, u16 offset, u16 words, u16 *data)
4056{
4057 s32 ret;
4058
4059 mutex_lock(&e1000_eeprom_lock);
4060 ret = e1000_do_write_eeprom(hw, offset, words, data);
4061 mutex_unlock(&e1000_eeprom_lock);
4062 return ret;
4063}
4064
4065static s32 e1000_do_write_eeprom(struct e1000_hw *hw, u16 offset, u16 words,
4066 u16 *data)
4067{
4068 struct e1000_eeprom_info *eeprom = &hw->eeprom;
4069 s32 status = 0;
4070
4071 if (hw->mac_type == e1000_ce4100) {
4072 GBE_CONFIG_FLASH_WRITE(GBE_CONFIG_BASE_VIRT, offset, words,
4073 data);
4074 return E1000_SUCCESS;
4075 }
4076
4077
4078
4079
4080 if ((offset >= eeprom->word_size) ||
4081 (words > eeprom->word_size - offset) ||
4082 (words == 0)) {
4083 e_dbg("\"words\" parameter out of bounds\n");
4084 return -E1000_ERR_EEPROM;
4085 }
4086
4087
4088 if (e1000_acquire_eeprom(hw) != E1000_SUCCESS)
4089 return -E1000_ERR_EEPROM;
4090
4091 if (eeprom->type == e1000_eeprom_microwire) {
4092 status = e1000_write_eeprom_microwire(hw, offset, words, data);
4093 } else {
4094 status = e1000_write_eeprom_spi(hw, offset, words, data);
4095 msleep(10);
4096 }
4097
4098
4099 e1000_release_eeprom(hw);
4100
4101 return status;
4102}
4103
4104
4105
4106
4107
4108
4109
4110
4111static s32 e1000_write_eeprom_spi(struct e1000_hw *hw, u16 offset, u16 words,
4112 u16 *data)
4113{
4114 struct e1000_eeprom_info *eeprom = &hw->eeprom;
4115 u16 widx = 0;
4116
4117 while (widx < words) {
4118 u8 write_opcode = EEPROM_WRITE_OPCODE_SPI;
4119
4120 if (e1000_spi_eeprom_ready(hw))
4121 return -E1000_ERR_EEPROM;
4122
4123 e1000_standby_eeprom(hw);
4124 cond_resched();
4125
4126
4127 e1000_shift_out_ee_bits(hw, EEPROM_WREN_OPCODE_SPI,
4128 eeprom->opcode_bits);
4129
4130 e1000_standby_eeprom(hw);
4131
4132
4133
4134
4135 if ((eeprom->address_bits == 8) && (offset >= 128))
4136 write_opcode |= EEPROM_A8_OPCODE_SPI;
4137
4138
4139 e1000_shift_out_ee_bits(hw, write_opcode, eeprom->opcode_bits);
4140
4141 e1000_shift_out_ee_bits(hw, (u16)((offset + widx) * 2),
4142 eeprom->address_bits);
4143
4144
4145
4146
4147
4148
4149 while (widx < words) {
4150 u16 word_out = data[widx];
4151
4152 word_out = (word_out >> 8) | (word_out << 8);
4153 e1000_shift_out_ee_bits(hw, word_out, 16);
4154 widx++;
4155
4156
4157
4158
4159
4160
4161 if ((((offset + widx) * 2) % eeprom->page_size) == 0) {
4162 e1000_standby_eeprom(hw);
4163 break;
4164 }
4165 }
4166 }
4167
4168 return E1000_SUCCESS;
4169}
4170
4171
4172
4173
4174
4175
4176
4177
4178static s32 e1000_write_eeprom_microwire(struct e1000_hw *hw, u16 offset,
4179 u16 words, u16 *data)
4180{
4181 struct e1000_eeprom_info *eeprom = &hw->eeprom;
4182 u32 eecd;
4183 u16 words_written = 0;
4184 u16 i = 0;
4185
4186
4187
4188
4189
4190
4191
4192 e1000_shift_out_ee_bits(hw, EEPROM_EWEN_OPCODE_MICROWIRE,
4193 (u16)(eeprom->opcode_bits + 2));
4194
4195 e1000_shift_out_ee_bits(hw, 0, (u16)(eeprom->address_bits - 2));
4196
4197
4198 e1000_standby_eeprom(hw);
4199
4200 while (words_written < words) {
4201
4202 e1000_shift_out_ee_bits(hw, EEPROM_WRITE_OPCODE_MICROWIRE,
4203 eeprom->opcode_bits);
4204
4205 e1000_shift_out_ee_bits(hw, (u16)(offset + words_written),
4206 eeprom->address_bits);
4207
4208
4209 e1000_shift_out_ee_bits(hw, data[words_written], 16);
4210
4211
4212
4213
4214 e1000_standby_eeprom(hw);
4215
4216
4217
4218
4219
4220
4221 for (i = 0; i < 200; i++) {
4222 eecd = er32(EECD);
4223 if (eecd & E1000_EECD_DO)
4224 break;
4225 udelay(50);
4226 }
4227 if (i == 200) {
4228 e_dbg("EEPROM Write did not complete\n");
4229 return -E1000_ERR_EEPROM;
4230 }
4231
4232
4233 e1000_standby_eeprom(hw);
4234 cond_resched();
4235
4236 words_written++;
4237 }
4238
4239
4240
4241
4242
4243
4244
4245 e1000_shift_out_ee_bits(hw, EEPROM_EWDS_OPCODE_MICROWIRE,
4246 (u16)(eeprom->opcode_bits + 2));
4247
4248 e1000_shift_out_ee_bits(hw, 0, (u16)(eeprom->address_bits - 2));
4249
4250 return E1000_SUCCESS;
4251}
4252
4253
4254
4255
4256
4257
4258
4259
4260s32 e1000_read_mac_addr(struct e1000_hw *hw)
4261{
4262 u16 offset;
4263 u16 eeprom_data, i;
4264
4265 for (i = 0; i < NODE_ADDRESS_SIZE; i += 2) {
4266 offset = i >> 1;
4267 if (e1000_read_eeprom(hw, offset, 1, &eeprom_data) < 0) {
4268 e_dbg("EEPROM Read Error\n");
4269 return -E1000_ERR_EEPROM;
4270 }
4271 hw->perm_mac_addr[i] = (u8)(eeprom_data & 0x00FF);
4272 hw->perm_mac_addr[i + 1] = (u8)(eeprom_data >> 8);
4273 }
4274
4275 switch (hw->mac_type) {
4276 default:
4277 break;
4278 case e1000_82546:
4279 case e1000_82546_rev_3:
4280 if (er32(STATUS) & E1000_STATUS_FUNC_1)
4281 hw->perm_mac_addr[5] ^= 0x01;
4282 break;
4283 }
4284
4285 for (i = 0; i < NODE_ADDRESS_SIZE; i++)
4286 hw->mac_addr[i] = hw->perm_mac_addr[i];
4287 return E1000_SUCCESS;
4288}
4289
4290
4291
4292
4293
4294
4295
4296
4297
4298static void e1000_init_rx_addrs(struct e1000_hw *hw)
4299{
4300 u32 i;
4301 u32 rar_num;
4302
4303
4304 e_dbg("Programming MAC Address into RAR[0]\n");
4305
4306 e1000_rar_set(hw, hw->mac_addr, 0);
4307
4308 rar_num = E1000_RAR_ENTRIES;
4309
4310
4311 e_dbg("Clearing RAR[1-15]\n");
4312 for (i = 1; i < rar_num; i++) {
4313 E1000_WRITE_REG_ARRAY(hw, RA, (i << 1), 0);
4314 E1000_WRITE_FLUSH();
4315 E1000_WRITE_REG_ARRAY(hw, RA, ((i << 1) + 1), 0);
4316 E1000_WRITE_FLUSH();
4317 }
4318}
4319
4320
4321
4322
4323
4324
4325u32 e1000_hash_mc_addr(struct e1000_hw *hw, u8 *mc_addr)
4326{
4327 u32 hash_value = 0;
4328
4329
4330
4331
4332 switch (hw->mc_filter_type) {
4333
4334
4335
4336
4337 case 0:
4338
4339 hash_value = ((mc_addr[4] >> 4) | (((u16)mc_addr[5]) << 4));
4340 break;
4341 case 1:
4342
4343 hash_value = ((mc_addr[4] >> 3) | (((u16)mc_addr[5]) << 5));
4344 break;
4345 case 2:
4346
4347 hash_value = ((mc_addr[4] >> 2) | (((u16)mc_addr[5]) << 6));
4348 break;
4349 case 3:
4350
4351 hash_value = ((mc_addr[4]) | (((u16)mc_addr[5]) << 8));
4352 break;
4353 }
4354
4355 hash_value &= 0xFFF;
4356 return hash_value;
4357}
4358
4359
4360
4361
4362
4363
4364
4365void e1000_rar_set(struct e1000_hw *hw, u8 *addr, u32 index)
4366{
4367 u32 rar_low, rar_high;
4368
4369
4370
4371
4372 rar_low = ((u32)addr[0] | ((u32)addr[1] << 8) |
4373 ((u32)addr[2] << 16) | ((u32)addr[3] << 24));
4374 rar_high = ((u32)addr[4] | ((u32)addr[5] << 8));
4375
4376
4377
4378
4379
4380
4381
4382
4383
4384
4385
4386
4387
4388
4389
4390
4391
4392
4393
4394 switch (hw->mac_type) {
4395 default:
4396
4397 rar_high |= E1000_RAH_AV;
4398 break;
4399 }
4400
4401 E1000_WRITE_REG_ARRAY(hw, RA, (index << 1), rar_low);
4402 E1000_WRITE_FLUSH();
4403 E1000_WRITE_REG_ARRAY(hw, RA, ((index << 1) + 1), rar_high);
4404 E1000_WRITE_FLUSH();
4405}
4406
4407
4408
4409
4410
4411
4412
4413void e1000_write_vfta(struct e1000_hw *hw, u32 offset, u32 value)
4414{
4415 u32 temp;
4416
4417 if ((hw->mac_type == e1000_82544) && ((offset & 0x1) == 1)) {
4418 temp = E1000_READ_REG_ARRAY(hw, VFTA, (offset - 1));
4419 E1000_WRITE_REG_ARRAY(hw, VFTA, offset, value);
4420 E1000_WRITE_FLUSH();
4421 E1000_WRITE_REG_ARRAY(hw, VFTA, (offset - 1), temp);
4422 E1000_WRITE_FLUSH();
4423 } else {
4424 E1000_WRITE_REG_ARRAY(hw, VFTA, offset, value);
4425 E1000_WRITE_FLUSH();
4426 }
4427}
4428
4429
4430
4431
4432
4433static void e1000_clear_vfta(struct e1000_hw *hw)
4434{
4435 u32 offset;
4436 u32 vfta_value = 0;
4437 u32 vfta_offset = 0;
4438 u32 vfta_bit_in_reg = 0;
4439
4440 for (offset = 0; offset < E1000_VLAN_FILTER_TBL_SIZE; offset++) {
4441
4442
4443
4444
4445 vfta_value = (offset == vfta_offset) ? vfta_bit_in_reg : 0;
4446 E1000_WRITE_REG_ARRAY(hw, VFTA, offset, vfta_value);
4447 E1000_WRITE_FLUSH();
4448 }
4449}
4450
4451static s32 e1000_id_led_init(struct e1000_hw *hw)
4452{
4453 u32 ledctl;
4454 const u32 ledctl_mask = 0x000000FF;
4455 const u32 ledctl_on = E1000_LEDCTL_MODE_LED_ON;
4456 const u32 ledctl_off = E1000_LEDCTL_MODE_LED_OFF;
4457 u16 eeprom_data, i, temp;
4458 const u16 led_mask = 0x0F;
4459
4460 if (hw->mac_type < e1000_82540) {
4461
4462 return E1000_SUCCESS;
4463 }
4464
4465 ledctl = er32(LEDCTL);
4466 hw->ledctl_default = ledctl;
4467 hw->ledctl_mode1 = hw->ledctl_default;
4468 hw->ledctl_mode2 = hw->ledctl_default;
4469
4470 if (e1000_read_eeprom(hw, EEPROM_ID_LED_SETTINGS, 1, &eeprom_data) < 0) {
4471 e_dbg("EEPROM Read Error\n");
4472 return -E1000_ERR_EEPROM;
4473 }
4474
4475 if ((eeprom_data == ID_LED_RESERVED_0000) ||
4476 (eeprom_data == ID_LED_RESERVED_FFFF)) {
4477 eeprom_data = ID_LED_DEFAULT;
4478 }
4479
4480 for (i = 0; i < 4; i++) {
4481 temp = (eeprom_data >> (i << 2)) & led_mask;
4482 switch (temp) {
4483 case ID_LED_ON1_DEF2:
4484 case ID_LED_ON1_ON2:
4485 case ID_LED_ON1_OFF2:
4486 hw->ledctl_mode1 &= ~(ledctl_mask << (i << 3));
4487 hw->ledctl_mode1 |= ledctl_on << (i << 3);
4488 break;
4489 case ID_LED_OFF1_DEF2:
4490 case ID_LED_OFF1_ON2:
4491 case ID_LED_OFF1_OFF2:
4492 hw->ledctl_mode1 &= ~(ledctl_mask << (i << 3));
4493 hw->ledctl_mode1 |= ledctl_off << (i << 3);
4494 break;
4495 default:
4496
4497 break;
4498 }
4499 switch (temp) {
4500 case ID_LED_DEF1_ON2:
4501 case ID_LED_ON1_ON2:
4502 case ID_LED_OFF1_ON2:
4503 hw->ledctl_mode2 &= ~(ledctl_mask << (i << 3));
4504 hw->ledctl_mode2 |= ledctl_on << (i << 3);
4505 break;
4506 case ID_LED_DEF1_OFF2:
4507 case ID_LED_ON1_OFF2:
4508 case ID_LED_OFF1_OFF2:
4509 hw->ledctl_mode2 &= ~(ledctl_mask << (i << 3));
4510 hw->ledctl_mode2 |= ledctl_off << (i << 3);
4511 break;
4512 default:
4513
4514 break;
4515 }
4516 }
4517 return E1000_SUCCESS;
4518}
4519
4520
4521
4522
4523
4524
4525
4526s32 e1000_setup_led(struct e1000_hw *hw)
4527{
4528 u32 ledctl;
4529 s32 ret_val = E1000_SUCCESS;
4530
4531 switch (hw->mac_type) {
4532 case e1000_82542_rev2_0:
4533 case e1000_82542_rev2_1:
4534 case e1000_82543:
4535 case e1000_82544:
4536
4537 break;
4538 case e1000_82541:
4539 case e1000_82547:
4540 case e1000_82541_rev_2:
4541 case e1000_82547_rev_2:
4542
4543 ret_val = e1000_read_phy_reg(hw, IGP01E1000_GMII_FIFO,
4544 &hw->phy_spd_default);
4545 if (ret_val)
4546 return ret_val;
4547 ret_val = e1000_write_phy_reg(hw, IGP01E1000_GMII_FIFO,
4548 (u16)(hw->phy_spd_default &
4549 ~IGP01E1000_GMII_SPD));
4550 if (ret_val)
4551 return ret_val;
4552
4553 default:
4554 if (hw->media_type == e1000_media_type_fiber) {
4555 ledctl = er32(LEDCTL);
4556
4557 hw->ledctl_default = ledctl;
4558
4559 ledctl &= ~(E1000_LEDCTL_LED0_IVRT |
4560 E1000_LEDCTL_LED0_BLINK |
4561 E1000_LEDCTL_LED0_MODE_MASK);
4562 ledctl |= (E1000_LEDCTL_MODE_LED_OFF <<
4563 E1000_LEDCTL_LED0_MODE_SHIFT);
4564 ew32(LEDCTL, ledctl);
4565 } else if (hw->media_type == e1000_media_type_copper)
4566 ew32(LEDCTL, hw->ledctl_mode1);
4567 break;
4568 }
4569
4570 return E1000_SUCCESS;
4571}
4572
4573
4574
4575
4576
4577s32 e1000_cleanup_led(struct e1000_hw *hw)
4578{
4579 s32 ret_val = E1000_SUCCESS;
4580
4581 switch (hw->mac_type) {
4582 case e1000_82542_rev2_0:
4583 case e1000_82542_rev2_1:
4584 case e1000_82543:
4585 case e1000_82544:
4586
4587 break;
4588 case e1000_82541:
4589 case e1000_82547:
4590 case e1000_82541_rev_2:
4591 case e1000_82547_rev_2:
4592
4593 ret_val = e1000_write_phy_reg(hw, IGP01E1000_GMII_FIFO,
4594 hw->phy_spd_default);
4595 if (ret_val)
4596 return ret_val;
4597
4598 default:
4599
4600 ew32(LEDCTL, hw->ledctl_default);
4601 break;
4602 }
4603
4604 return E1000_SUCCESS;
4605}
4606
4607
4608
4609
4610
4611s32 e1000_led_on(struct e1000_hw *hw)
4612{
4613 u32 ctrl = er32(CTRL);
4614
4615 switch (hw->mac_type) {
4616 case e1000_82542_rev2_0:
4617 case e1000_82542_rev2_1:
4618 case e1000_82543:
4619
4620 ctrl |= E1000_CTRL_SWDPIN0;
4621 ctrl |= E1000_CTRL_SWDPIO0;
4622 break;
4623 case e1000_82544:
4624 if (hw->media_type == e1000_media_type_fiber) {
4625
4626 ctrl |= E1000_CTRL_SWDPIN0;
4627 ctrl |= E1000_CTRL_SWDPIO0;
4628 } else {
4629
4630 ctrl &= ~E1000_CTRL_SWDPIN0;
4631 ctrl |= E1000_CTRL_SWDPIO0;
4632 }
4633 break;
4634 default:
4635 if (hw->media_type == e1000_media_type_fiber) {
4636
4637 ctrl &= ~E1000_CTRL_SWDPIN0;
4638 ctrl |= E1000_CTRL_SWDPIO0;
4639 } else if (hw->media_type == e1000_media_type_copper) {
4640 ew32(LEDCTL, hw->ledctl_mode2);
4641 return E1000_SUCCESS;
4642 }
4643 break;
4644 }
4645
4646 ew32(CTRL, ctrl);
4647
4648 return E1000_SUCCESS;
4649}
4650
4651
4652
4653
4654
4655s32 e1000_led_off(struct e1000_hw *hw)
4656{
4657 u32 ctrl = er32(CTRL);
4658
4659 switch (hw->mac_type) {
4660 case e1000_82542_rev2_0:
4661 case e1000_82542_rev2_1:
4662 case e1000_82543:
4663
4664 ctrl &= ~E1000_CTRL_SWDPIN0;
4665 ctrl |= E1000_CTRL_SWDPIO0;
4666 break;
4667 case e1000_82544:
4668 if (hw->media_type == e1000_media_type_fiber) {
4669
4670 ctrl &= ~E1000_CTRL_SWDPIN0;
4671 ctrl |= E1000_CTRL_SWDPIO0;
4672 } else {
4673
4674 ctrl |= E1000_CTRL_SWDPIN0;
4675 ctrl |= E1000_CTRL_SWDPIO0;
4676 }
4677 break;
4678 default:
4679 if (hw->media_type == e1000_media_type_fiber) {
4680
4681 ctrl |= E1000_CTRL_SWDPIN0;
4682 ctrl |= E1000_CTRL_SWDPIO0;
4683 } else if (hw->media_type == e1000_media_type_copper) {
4684 ew32(LEDCTL, hw->ledctl_mode1);
4685 return E1000_SUCCESS;
4686 }
4687 break;
4688 }
4689
4690 ew32(CTRL, ctrl);
4691
4692 return E1000_SUCCESS;
4693}
4694
4695
4696
4697
4698
4699static void e1000_clear_hw_cntrs(struct e1000_hw *hw)
4700{
4701 volatile u32 temp;
4702
4703 temp = er32(CRCERRS);
4704 temp = er32(SYMERRS);
4705 temp = er32(MPC);
4706 temp = er32(SCC);
4707 temp = er32(ECOL);
4708 temp = er32(MCC);
4709 temp = er32(LATECOL);
4710 temp = er32(COLC);
4711 temp = er32(DC);
4712 temp = er32(SEC);
4713 temp = er32(RLEC);
4714 temp = er32(XONRXC);
4715 temp = er32(XONTXC);
4716 temp = er32(XOFFRXC);
4717 temp = er32(XOFFTXC);
4718 temp = er32(FCRUC);
4719
4720 temp = er32(PRC64);
4721 temp = er32(PRC127);
4722 temp = er32(PRC255);
4723 temp = er32(PRC511);
4724 temp = er32(PRC1023);
4725 temp = er32(PRC1522);
4726
4727 temp = er32(GPRC);
4728 temp = er32(BPRC);
4729 temp = er32(MPRC);
4730 temp = er32(GPTC);
4731 temp = er32(GORCL);
4732 temp = er32(GORCH);
4733 temp = er32(GOTCL);
4734 temp = er32(GOTCH);
4735 temp = er32(RNBC);
4736 temp = er32(RUC);
4737 temp = er32(RFC);
4738 temp = er32(ROC);
4739 temp = er32(RJC);
4740 temp = er32(TORL);
4741 temp = er32(TORH);
4742 temp = er32(TOTL);
4743 temp = er32(TOTH);
4744 temp = er32(TPR);
4745 temp = er32(TPT);
4746
4747 temp = er32(PTC64);
4748 temp = er32(PTC127);
4749 temp = er32(PTC255);
4750 temp = er32(PTC511);
4751 temp = er32(PTC1023);
4752 temp = er32(PTC1522);
4753
4754 temp = er32(MPTC);
4755 temp = er32(BPTC);
4756
4757 if (hw->mac_type < e1000_82543)
4758 return;
4759
4760 temp = er32(ALGNERRC);
4761 temp = er32(RXERRC);
4762 temp = er32(TNCRS);
4763 temp = er32(CEXTERR);
4764 temp = er32(TSCTC);
4765 temp = er32(TSCTFC);
4766
4767 if (hw->mac_type <= e1000_82544)
4768 return;
4769
4770 temp = er32(MGTPRC);
4771 temp = er32(MGTPDC);
4772 temp = er32(MGTPTC);
4773}
4774
4775
4776
4777
4778
4779
4780
4781
4782
4783
4784void e1000_reset_adaptive(struct e1000_hw *hw)
4785{
4786 if (hw->adaptive_ifs) {
4787 if (!hw->ifs_params_forced) {
4788 hw->current_ifs_val = 0;
4789 hw->ifs_min_val = IFS_MIN;
4790 hw->ifs_max_val = IFS_MAX;
4791 hw->ifs_step_size = IFS_STEP;
4792 hw->ifs_ratio = IFS_RATIO;
4793 }
4794 hw->in_ifs_mode = false;
4795 ew32(AIT, 0);
4796 } else {
4797 e_dbg("Not in Adaptive IFS mode!\n");
4798 }
4799}
4800
4801
4802
4803
4804
4805
4806
4807
4808
4809
4810void e1000_update_adaptive(struct e1000_hw *hw)
4811{
4812 if (hw->adaptive_ifs) {
4813 if ((hw->collision_delta * hw->ifs_ratio) > hw->tx_packet_delta) {
4814 if (hw->tx_packet_delta > MIN_NUM_XMITS) {
4815 hw->in_ifs_mode = true;
4816 if (hw->current_ifs_val < hw->ifs_max_val) {
4817 if (hw->current_ifs_val == 0)
4818 hw->current_ifs_val =
4819 hw->ifs_min_val;
4820 else
4821 hw->current_ifs_val +=
4822 hw->ifs_step_size;
4823 ew32(AIT, hw->current_ifs_val);
4824 }
4825 }
4826 } else {
4827 if (hw->in_ifs_mode &&
4828 (hw->tx_packet_delta <= MIN_NUM_XMITS)) {
4829 hw->current_ifs_val = 0;
4830 hw->in_ifs_mode = false;
4831 ew32(AIT, 0);
4832 }
4833 }
4834 } else {
4835 e_dbg("Not in Adaptive IFS mode!\n");
4836 }
4837}
4838
4839
4840
4841
4842
4843
4844
4845void e1000_get_bus_info(struct e1000_hw *hw)
4846{
4847 u32 status;
4848
4849 switch (hw->mac_type) {
4850 case e1000_82542_rev2_0:
4851 case e1000_82542_rev2_1:
4852 hw->bus_type = e1000_bus_type_pci;
4853 hw->bus_speed = e1000_bus_speed_unknown;
4854 hw->bus_width = e1000_bus_width_unknown;
4855 break;
4856 default:
4857 status = er32(STATUS);
4858 hw->bus_type = (status & E1000_STATUS_PCIX_MODE) ?
4859 e1000_bus_type_pcix : e1000_bus_type_pci;
4860
4861 if (hw->device_id == E1000_DEV_ID_82546EB_QUAD_COPPER) {
4862 hw->bus_speed = (hw->bus_type == e1000_bus_type_pci) ?
4863 e1000_bus_speed_66 : e1000_bus_speed_120;
4864 } else if (hw->bus_type == e1000_bus_type_pci) {
4865 hw->bus_speed = (status & E1000_STATUS_PCI66) ?
4866 e1000_bus_speed_66 : e1000_bus_speed_33;
4867 } else {
4868 switch (status & E1000_STATUS_PCIX_SPEED) {
4869 case E1000_STATUS_PCIX_SPEED_66:
4870 hw->bus_speed = e1000_bus_speed_66;
4871 break;
4872 case E1000_STATUS_PCIX_SPEED_100:
4873 hw->bus_speed = e1000_bus_speed_100;
4874 break;
4875 case E1000_STATUS_PCIX_SPEED_133:
4876 hw->bus_speed = e1000_bus_speed_133;
4877 break;
4878 default:
4879 hw->bus_speed = e1000_bus_speed_reserved;
4880 break;
4881 }
4882 }
4883 hw->bus_width = (status & E1000_STATUS_BUS64) ?
4884 e1000_bus_width_64 : e1000_bus_width_32;
4885 break;
4886 }
4887}
4888
4889
4890
4891
4892
4893
4894
4895
4896
4897
4898static void e1000_write_reg_io(struct e1000_hw *hw, u32 offset, u32 value)
4899{
4900 unsigned long io_addr = hw->io_base;
4901 unsigned long io_data = hw->io_base + 4;
4902
4903 e1000_io_write(hw, io_addr, offset);
4904 e1000_io_write(hw, io_data, value);
4905}
4906
4907
4908
4909
4910
4911
4912
4913
4914
4915
4916
4917
4918
4919
4920
4921static s32 e1000_get_cable_length(struct e1000_hw *hw, u16 *min_length,
4922 u16 *max_length)
4923{
4924 s32 ret_val;
4925 u16 agc_value = 0;
4926 u16 i, phy_data;
4927 u16 cable_length;
4928
4929 *min_length = *max_length = 0;
4930
4931
4932 if (hw->phy_type == e1000_phy_m88) {
4933 ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS,
4934 &phy_data);
4935 if (ret_val)
4936 return ret_val;
4937 cable_length = (phy_data & M88E1000_PSSR_CABLE_LENGTH) >>
4938 M88E1000_PSSR_CABLE_LENGTH_SHIFT;
4939
4940
4941 switch (cable_length) {
4942 case e1000_cable_length_50:
4943 *min_length = 0;
4944 *max_length = e1000_igp_cable_length_50;
4945 break;
4946 case e1000_cable_length_50_80:
4947 *min_length = e1000_igp_cable_length_50;
4948 *max_length = e1000_igp_cable_length_80;
4949 break;
4950 case e1000_cable_length_80_110:
4951 *min_length = e1000_igp_cable_length_80;
4952 *max_length = e1000_igp_cable_length_110;
4953 break;
4954 case e1000_cable_length_110_140:
4955 *min_length = e1000_igp_cable_length_110;
4956 *max_length = e1000_igp_cable_length_140;
4957 break;
4958 case e1000_cable_length_140:
4959 *min_length = e1000_igp_cable_length_140;
4960 *max_length = e1000_igp_cable_length_170;
4961 break;
4962 default:
4963 return -E1000_ERR_PHY;
4964 }
4965 } else if (hw->phy_type == e1000_phy_igp) {
4966 u16 cur_agc_value;
4967 u16 min_agc_value = IGP01E1000_AGC_LENGTH_TABLE_SIZE;
4968 static const u16 agc_reg_array[IGP01E1000_PHY_CHANNEL_NUM] = {
4969 IGP01E1000_PHY_AGC_A,
4970 IGP01E1000_PHY_AGC_B,
4971 IGP01E1000_PHY_AGC_C,
4972 IGP01E1000_PHY_AGC_D
4973 };
4974
4975 for (i = 0; i < IGP01E1000_PHY_CHANNEL_NUM; i++) {
4976 ret_val =
4977 e1000_read_phy_reg(hw, agc_reg_array[i], &phy_data);
4978 if (ret_val)
4979 return ret_val;
4980
4981 cur_agc_value = phy_data >> IGP01E1000_AGC_LENGTH_SHIFT;
4982
4983
4984 if ((cur_agc_value >=
4985 IGP01E1000_AGC_LENGTH_TABLE_SIZE - 1) ||
4986 (cur_agc_value == 0))
4987 return -E1000_ERR_PHY;
4988
4989 agc_value += cur_agc_value;
4990
4991
4992 if (min_agc_value > cur_agc_value)
4993 min_agc_value = cur_agc_value;
4994 }
4995
4996
4997 if (agc_value <
4998 IGP01E1000_PHY_CHANNEL_NUM * e1000_igp_cable_length_50) {
4999 agc_value -= min_agc_value;
5000
5001
5002 agc_value /= (IGP01E1000_PHY_CHANNEL_NUM - 1);
5003 } else {
5004
5005 agc_value /= IGP01E1000_PHY_CHANNEL_NUM;
5006 }
5007
5008
5009 *min_length = ((e1000_igp_cable_length_table[agc_value] -
5010 IGP01E1000_AGC_RANGE) > 0) ?
5011 (e1000_igp_cable_length_table[agc_value] -
5012 IGP01E1000_AGC_RANGE) : 0;
5013 *max_length = e1000_igp_cable_length_table[agc_value] +
5014 IGP01E1000_AGC_RANGE;
5015 }
5016
5017 return E1000_SUCCESS;
5018}
5019
5020
5021
5022
5023
5024
5025
5026
5027
5028
5029
5030
5031
5032
5033
5034
5035static s32 e1000_check_polarity(struct e1000_hw *hw,
5036 e1000_rev_polarity *polarity)
5037{
5038 s32 ret_val;
5039 u16 phy_data;
5040
5041 if (hw->phy_type == e1000_phy_m88) {
5042
5043 ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS,
5044 &phy_data);
5045 if (ret_val)
5046 return ret_val;
5047 *polarity = ((phy_data & M88E1000_PSSR_REV_POLARITY) >>
5048 M88E1000_PSSR_REV_POLARITY_SHIFT) ?
5049 e1000_rev_polarity_reversed : e1000_rev_polarity_normal;
5050
5051 } else if (hw->phy_type == e1000_phy_igp) {
5052
5053 ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_STATUS,
5054 &phy_data);
5055 if (ret_val)
5056 return ret_val;
5057
5058
5059
5060
5061 if ((phy_data & IGP01E1000_PSSR_SPEED_MASK) ==
5062 IGP01E1000_PSSR_SPEED_1000MBPS) {
5063
5064 ret_val =
5065 e1000_read_phy_reg(hw, IGP01E1000_PHY_PCS_INIT_REG,
5066 &phy_data);
5067 if (ret_val)
5068 return ret_val;
5069
5070
5071 *polarity = (phy_data & IGP01E1000_PHY_POLARITY_MASK) ?
5072 e1000_rev_polarity_reversed :
5073 e1000_rev_polarity_normal;
5074 } else {
5075
5076
5077
5078 *polarity =
5079 (phy_data & IGP01E1000_PSSR_POLARITY_REVERSED) ?
5080 e1000_rev_polarity_reversed :
5081 e1000_rev_polarity_normal;
5082 }
5083 }
5084 return E1000_SUCCESS;
5085}
5086
5087
5088
5089
5090
5091
5092
5093
5094
5095
5096
5097
5098
5099
5100
5101static s32 e1000_check_downshift(struct e1000_hw *hw)
5102{
5103 s32 ret_val;
5104 u16 phy_data;
5105
5106 if (hw->phy_type == e1000_phy_igp) {
5107 ret_val = e1000_read_phy_reg(hw, IGP01E1000_PHY_LINK_HEALTH,
5108 &phy_data);
5109 if (ret_val)
5110 return ret_val;
5111
5112 hw->speed_downgraded =
5113 (phy_data & IGP01E1000_PLHR_SS_DOWNGRADE) ? 1 : 0;
5114 } else if (hw->phy_type == e1000_phy_m88) {
5115 ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_SPEC_STATUS,
5116 &phy_data);
5117 if (ret_val)
5118 return ret_val;
5119
5120 hw->speed_downgraded = (phy_data & M88E1000_PSSR_DOWNSHIFT) >>
5121 M88E1000_PSSR_DOWNSHIFT_SHIFT;
5122 }
5123
5124 return E1000_SUCCESS;
5125}
5126
5127static const u16 dsp_reg_array[IGP01E1000_PHY_CHANNEL_NUM] = {
5128 IGP01E1000_PHY_AGC_PARAM_A,
5129 IGP01E1000_PHY_AGC_PARAM_B,
5130 IGP01E1000_PHY_AGC_PARAM_C,
5131 IGP01E1000_PHY_AGC_PARAM_D
5132};
5133
5134static s32 e1000_1000Mb_check_cable_length(struct e1000_hw *hw)
5135{
5136 u16 min_length, max_length;
5137 u16 phy_data, i;
5138 s32 ret_val;
5139
5140 ret_val = e1000_get_cable_length(hw, &min_length, &max_length);
5141 if (ret_val)
5142 return ret_val;
5143
5144 if (hw->dsp_config_state != e1000_dsp_config_enabled)
5145 return 0;
5146
5147 if (min_length >= e1000_igp_cable_length_50) {
5148 for (i = 0; i < IGP01E1000_PHY_CHANNEL_NUM; i++) {
5149 ret_val = e1000_read_phy_reg(hw, dsp_reg_array[i],
5150 &phy_data);
5151 if (ret_val)
5152 return ret_val;
5153
5154 phy_data &= ~IGP01E1000_PHY_EDAC_MU_INDEX;
5155
5156 ret_val = e1000_write_phy_reg(hw, dsp_reg_array[i],
5157 phy_data);
5158 if (ret_val)
5159 return ret_val;
5160 }
5161 hw->dsp_config_state = e1000_dsp_config_activated;
5162 } else {
5163 u16 ffe_idle_err_timeout = FFE_IDLE_ERR_COUNT_TIMEOUT_20;
5164 u32 idle_errs = 0;
5165
5166
5167 ret_val = e1000_read_phy_reg(hw, PHY_1000T_STATUS, &phy_data);
5168 if (ret_val)
5169 return ret_val;
5170
5171 for (i = 0; i < ffe_idle_err_timeout; i++) {
5172 udelay(1000);
5173 ret_val = e1000_read_phy_reg(hw, PHY_1000T_STATUS,
5174 &phy_data);
5175 if (ret_val)
5176 return ret_val;
5177
5178 idle_errs += (phy_data & SR_1000T_IDLE_ERROR_CNT);
5179 if (idle_errs > SR_1000T_PHY_EXCESSIVE_IDLE_ERR_COUNT) {
5180 hw->ffe_config_state = e1000_ffe_config_active;
5181
5182 ret_val = e1000_write_phy_reg(hw,
5183 IGP01E1000_PHY_DSP_FFE,
5184 IGP01E1000_PHY_DSP_FFE_CM_CP);
5185 if (ret_val)
5186 return ret_val;
5187 break;
5188 }
5189
5190 if (idle_errs)
5191 ffe_idle_err_timeout =
5192 FFE_IDLE_ERR_COUNT_TIMEOUT_100;
5193 }
5194 }
5195
5196 return 0;
5197}
5198
5199
5200
5201
5202
5203
5204
5205
5206
5207
5208
5209
5210
5211static s32 e1000_config_dsp_after_link_change(struct e1000_hw *hw, bool link_up)
5212{
5213 s32 ret_val;
5214 u16 phy_data, phy_saved_data, speed, duplex, i;
5215
5216 if (hw->phy_type != e1000_phy_igp)
5217 return E1000_SUCCESS;
5218
5219 if (link_up) {
5220 ret_val = e1000_get_speed_and_duplex(hw, &speed, &duplex);
5221 if (ret_val) {
5222 e_dbg("Error getting link speed and duplex\n");
5223 return ret_val;
5224 }
5225
5226 if (speed == SPEED_1000) {
5227 ret_val = e1000_1000Mb_check_cable_length(hw);
5228 if (ret_val)
5229 return ret_val;
5230 }
5231 } else {
5232 if (hw->dsp_config_state == e1000_dsp_config_activated) {
5233
5234
5235
5236 ret_val =
5237 e1000_read_phy_reg(hw, 0x2F5B, &phy_saved_data);
5238
5239 if (ret_val)
5240 return ret_val;
5241
5242
5243 ret_val = e1000_write_phy_reg(hw, 0x2F5B, 0x0003);
5244
5245 if (ret_val)
5246 return ret_val;
5247
5248 msleep(20);
5249
5250 ret_val = e1000_write_phy_reg(hw, 0x0000,
5251 IGP01E1000_IEEE_FORCE_GIGA);
5252 if (ret_val)
5253 return ret_val;
5254 for (i = 0; i < IGP01E1000_PHY_CHANNEL_NUM; i++) {
5255 ret_val =
5256 e1000_read_phy_reg(hw, dsp_reg_array[i],
5257 &phy_data);
5258 if (ret_val)
5259 return ret_val;
5260
5261 phy_data &= ~IGP01E1000_PHY_EDAC_MU_INDEX;
5262 phy_data |= IGP01E1000_PHY_EDAC_SIGN_EXT_9_BITS;
5263
5264 ret_val =
5265 e1000_write_phy_reg(hw, dsp_reg_array[i],
5266 phy_data);
5267 if (ret_val)
5268 return ret_val;
5269 }
5270
5271 ret_val = e1000_write_phy_reg(hw, 0x0000,
5272 IGP01E1000_IEEE_RESTART_AUTONEG);
5273 if (ret_val)
5274 return ret_val;
5275
5276 msleep(20);
5277
5278
5279 ret_val =
5280 e1000_write_phy_reg(hw, 0x2F5B, phy_saved_data);
5281
5282 if (ret_val)
5283 return ret_val;
5284
5285 hw->dsp_config_state = e1000_dsp_config_enabled;
5286 }
5287
5288 if (hw->ffe_config_state == e1000_ffe_config_active) {
5289
5290
5291
5292 ret_val =
5293 e1000_read_phy_reg(hw, 0x2F5B, &phy_saved_data);
5294
5295 if (ret_val)
5296 return ret_val;
5297
5298
5299 ret_val = e1000_write_phy_reg(hw, 0x2F5B, 0x0003);
5300
5301 if (ret_val)
5302 return ret_val;
5303
5304 msleep(20);
5305
5306 ret_val = e1000_write_phy_reg(hw, 0x0000,
5307 IGP01E1000_IEEE_FORCE_GIGA);
5308 if (ret_val)
5309 return ret_val;
5310 ret_val =
5311 e1000_write_phy_reg(hw, IGP01E1000_PHY_DSP_FFE,
5312 IGP01E1000_PHY_DSP_FFE_DEFAULT);
5313 if (ret_val)
5314 return ret_val;
5315
5316 ret_val = e1000_write_phy_reg(hw, 0x0000,
5317 IGP01E1000_IEEE_RESTART_AUTONEG);
5318 if (ret_val)
5319 return ret_val;
5320
5321 msleep(20);
5322
5323
5324 ret_val =
5325 e1000_write_phy_reg(hw, 0x2F5B, phy_saved_data);
5326
5327 if (ret_val)
5328 return ret_val;
5329
5330 hw->ffe_config_state = e1000_ffe_config_enabled;
5331 }
5332 }
5333 return E1000_SUCCESS;
5334}
5335
5336
5337
5338
5339
5340
5341
5342
5343
5344static s32 e1000_set_phy_mode(struct e1000_hw *hw)
5345{
5346 s32 ret_val;
5347 u16 eeprom_data;
5348
5349 if ((hw->mac_type == e1000_82545_rev_3) &&
5350 (hw->media_type == e1000_media_type_copper)) {
5351 ret_val =
5352 e1000_read_eeprom(hw, EEPROM_PHY_CLASS_WORD, 1,
5353 &eeprom_data);
5354 if (ret_val)
5355 return ret_val;
5356
5357 if ((eeprom_data != EEPROM_RESERVED_WORD) &&
5358 (eeprom_data & EEPROM_PHY_CLASS_A)) {
5359 ret_val =
5360 e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT,
5361 0x000B);
5362 if (ret_val)
5363 return ret_val;
5364 ret_val =
5365 e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL,
5366 0x8104);
5367 if (ret_val)
5368 return ret_val;
5369
5370 hw->phy_reset_disable = false;
5371 }
5372 }
5373
5374 return E1000_SUCCESS;
5375}
5376
5377
5378
5379
5380
5381
5382
5383
5384
5385
5386
5387
5388
5389
5390static s32 e1000_set_d3_lplu_state(struct e1000_hw *hw, bool active)
5391{
5392 s32 ret_val;
5393 u16 phy_data;
5394
5395 if (hw->phy_type != e1000_phy_igp)
5396 return E1000_SUCCESS;
5397
5398
5399
5400
5401
5402 if (hw->mac_type == e1000_82541_rev_2 ||
5403 hw->mac_type == e1000_82547_rev_2) {
5404 ret_val =
5405 e1000_read_phy_reg(hw, IGP01E1000_GMII_FIFO, &phy_data);
5406 if (ret_val)
5407 return ret_val;
5408 }
5409
5410 if (!active) {
5411 if (hw->mac_type == e1000_82541_rev_2 ||
5412 hw->mac_type == e1000_82547_rev_2) {
5413 phy_data &= ~IGP01E1000_GMII_FLEX_SPD;
5414 ret_val =
5415 e1000_write_phy_reg(hw, IGP01E1000_GMII_FIFO,
5416 phy_data);
5417 if (ret_val)
5418 return ret_val;
5419 }
5420
5421
5422
5423
5424
5425
5426 if (hw->smart_speed == e1000_smart_speed_on) {
5427 ret_val =
5428 e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
5429 &phy_data);
5430 if (ret_val)
5431 return ret_val;
5432
5433 phy_data |= IGP01E1000_PSCFR_SMART_SPEED;
5434 ret_val =
5435 e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
5436 phy_data);
5437 if (ret_val)
5438 return ret_val;
5439 } else if (hw->smart_speed == e1000_smart_speed_off) {
5440 ret_val =
5441 e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
5442 &phy_data);
5443 if (ret_val)
5444 return ret_val;
5445
5446 phy_data &= ~IGP01E1000_PSCFR_SMART_SPEED;
5447 ret_val =
5448 e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
5449 phy_data);
5450 if (ret_val)
5451 return ret_val;
5452 }
5453 } else if ((hw->autoneg_advertised == AUTONEG_ADVERTISE_SPEED_DEFAULT) ||
5454 (hw->autoneg_advertised == AUTONEG_ADVERTISE_10_ALL) ||
5455 (hw->autoneg_advertised == AUTONEG_ADVERTISE_10_100_ALL)) {
5456 if (hw->mac_type == e1000_82541_rev_2 ||
5457 hw->mac_type == e1000_82547_rev_2) {
5458 phy_data |= IGP01E1000_GMII_FLEX_SPD;
5459 ret_val =
5460 e1000_write_phy_reg(hw, IGP01E1000_GMII_FIFO,
5461 phy_data);
5462 if (ret_val)
5463 return ret_val;
5464 }
5465
5466
5467 ret_val =
5468 e1000_read_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
5469 &phy_data);
5470 if (ret_val)
5471 return ret_val;
5472
5473 phy_data &= ~IGP01E1000_PSCFR_SMART_SPEED;
5474 ret_val =
5475 e1000_write_phy_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
5476 phy_data);
5477 if (ret_val)
5478 return ret_val;
5479 }
5480 return E1000_SUCCESS;
5481}
5482
5483
5484
5485
5486
5487
5488
5489static s32 e1000_set_vco_speed(struct e1000_hw *hw)
5490{
5491 s32 ret_val;
5492 u16 default_page = 0;
5493 u16 phy_data;
5494
5495 switch (hw->mac_type) {
5496 case e1000_82545_rev_3:
5497 case e1000_82546_rev_3:
5498 break;
5499 default:
5500 return E1000_SUCCESS;
5501 }
5502
5503
5504
5505 ret_val =
5506 e1000_read_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, &default_page);
5507 if (ret_val)
5508 return ret_val;
5509
5510 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x0005);
5511 if (ret_val)
5512 return ret_val;
5513
5514 ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, &phy_data);
5515 if (ret_val)
5516 return ret_val;
5517
5518 phy_data &= ~M88E1000_PHY_VCO_REG_BIT8;
5519 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, phy_data);
5520 if (ret_val)
5521 return ret_val;
5522
5523
5524
5525 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x0004);
5526 if (ret_val)
5527 return ret_val;
5528
5529 ret_val = e1000_read_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, &phy_data);
5530 if (ret_val)
5531 return ret_val;
5532
5533 phy_data |= M88E1000_PHY_VCO_REG_BIT11;
5534 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, phy_data);
5535 if (ret_val)
5536 return ret_val;
5537
5538 ret_val =
5539 e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, default_page);
5540 if (ret_val)
5541 return ret_val;
5542
5543 return E1000_SUCCESS;
5544}
5545
5546
5547
5548
5549
5550
5551
5552
5553u32 e1000_enable_mng_pass_thru(struct e1000_hw *hw)
5554{
5555 u32 manc;
5556
5557 if (hw->asf_firmware_present) {
5558 manc = er32(MANC);
5559
5560 if (!(manc & E1000_MANC_RCV_TCO_EN) ||
5561 !(manc & E1000_MANC_EN_MAC_ADDR_FILTER))
5562 return false;
5563 if ((manc & E1000_MANC_SMBUS_EN) && !(manc & E1000_MANC_ASF_EN))
5564 return true;
5565 }
5566 return false;
5567}
5568
5569static s32 e1000_polarity_reversal_workaround(struct e1000_hw *hw)
5570{
5571 s32 ret_val;
5572 u16 mii_status_reg;
5573 u16 i;
5574
5575
5576
5577
5578
5579 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x0019);
5580 if (ret_val)
5581 return ret_val;
5582 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, 0xFFFF);
5583 if (ret_val)
5584 return ret_val;
5585
5586 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x0000);
5587 if (ret_val)
5588 return ret_val;
5589
5590
5591 for (i = PHY_FORCE_TIME; i > 0; i--) {
5592
5593
5594
5595
5596 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
5597 if (ret_val)
5598 return ret_val;
5599
5600 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
5601 if (ret_val)
5602 return ret_val;
5603
5604 if ((mii_status_reg & ~MII_SR_LINK_STATUS) == 0)
5605 break;
5606 msleep(100);
5607 }
5608
5609
5610 msleep(1000);
5611
5612
5613
5614 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x0019);
5615 if (ret_val)
5616 return ret_val;
5617 msleep(50);
5618 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, 0xFFF0);
5619 if (ret_val)
5620 return ret_val;
5621 msleep(50);
5622 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, 0xFF00);
5623 if (ret_val)
5624 return ret_val;
5625 msleep(50);
5626 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_GEN_CONTROL, 0x0000);
5627 if (ret_val)
5628 return ret_val;
5629
5630 ret_val = e1000_write_phy_reg(hw, M88E1000_PHY_PAGE_SELECT, 0x0000);
5631 if (ret_val)
5632 return ret_val;
5633
5634
5635 for (i = PHY_FORCE_TIME; i > 0; i--) {
5636
5637
5638
5639
5640 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
5641 if (ret_val)
5642 return ret_val;
5643
5644 ret_val = e1000_read_phy_reg(hw, PHY_STATUS, &mii_status_reg);
5645 if (ret_val)
5646 return ret_val;
5647
5648 if (mii_status_reg & MII_SR_LINK_STATUS)
5649 break;
5650 msleep(100);
5651 }
5652 return E1000_SUCCESS;
5653}
5654
5655
5656
5657
5658
5659
5660
5661
5662
5663static s32 e1000_get_auto_rd_done(struct e1000_hw *hw)
5664{
5665 msleep(5);
5666 return E1000_SUCCESS;
5667}
5668
5669
5670
5671
5672
5673
5674
5675
5676
5677static s32 e1000_get_phy_cfg_done(struct e1000_hw *hw)
5678{
5679 msleep(10);
5680 return E1000_SUCCESS;
5681}
5682