1 /******************************************************************************
2 SPDX-License-Identifier: BSD-3-Clause
3
4 Copyright (c) 2001-2020, Intel Corporation
5 All rights reserved.
6
7 Redistribution and use in source and binary forms, with or without
8 modification, are permitted provided that the following conditions are met:
9
10 1. Redistributions of source code must retain the above copyright notice,
11 this list of conditions and the following disclaimer.
12
13 2. Redistributions in binary form must reproduce the above copyright
14 notice, this list of conditions and the following disclaimer in the
15 documentation and/or other materials provided with the distribution.
16
17 3. Neither the name of the Intel Corporation nor the names of its
18 contributors may be used to endorse or promote products derived from
19 this software without specific prior written permission.
20
21 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
22 AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23 IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24 ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
25 LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
26 CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
27 SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
28 INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
29 CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30 ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31 POSSIBILITY OF SUCH DAMAGE.
32
33 ******************************************************************************/
34 /*$FreeBSD$*/
35
36 #include "e1000_api.h"
37
38 static s32 e1000_wait_autoneg(struct e1000_hw *hw);
39 static s32 e1000_access_phy_wakeup_reg_bm(struct e1000_hw *hw, u32 offset,
40 u16 *data, bool read, bool page_set);
41 static u32 e1000_get_phy_addr_for_hv_page(u32 page);
42 static s32 e1000_access_phy_debug_regs_hv(struct e1000_hw *hw, u32 offset,
43 u16 *data, bool read);
44
45 /* Cable length tables */
46 static const u16 e1000_m88_cable_length_table[] = {
47 0, 50, 80, 110, 140, 140, E1000_CABLE_LENGTH_UNDEFINED };
48 #define M88E1000_CABLE_LENGTH_TABLE_SIZE \
49 (sizeof(e1000_m88_cable_length_table) / \
50 sizeof(e1000_m88_cable_length_table[0]))
51
52 static const u16 e1000_igp_2_cable_length_table[] = {
53 0, 0, 0, 0, 0, 0, 0, 0, 3, 5, 8, 11, 13, 16, 18, 21, 0, 0, 0, 3,
54 6, 10, 13, 16, 19, 23, 26, 29, 32, 35, 38, 41, 6, 10, 14, 18, 22,
55 26, 30, 33, 37, 41, 44, 48, 51, 54, 58, 61, 21, 26, 31, 35, 40,
56 44, 49, 53, 57, 61, 65, 68, 72, 75, 79, 82, 40, 45, 51, 56, 61,
57 66, 70, 75, 79, 83, 87, 91, 94, 98, 101, 104, 60, 66, 72, 77, 82,
58 87, 92, 96, 100, 104, 108, 111, 114, 117, 119, 121, 83, 89, 95,
59 100, 105, 109, 113, 116, 119, 122, 124, 104, 109, 114, 118, 121,
60 124};
61 #define IGP02E1000_CABLE_LENGTH_TABLE_SIZE \
62 (sizeof(e1000_igp_2_cable_length_table) / \
63 sizeof(e1000_igp_2_cable_length_table[0]))
64
65 /**
66 * e1000_init_phy_ops_generic - Initialize PHY function pointers
67 * @hw: pointer to the HW structure
68 *
69 * Setups up the function pointers to no-op functions
70 **/
71 void e1000_init_phy_ops_generic(struct e1000_hw *hw)
72 {
73 struct e1000_phy_info *phy = &hw->phy;
74 DEBUGFUNC("e1000_init_phy_ops_generic");
75
76 /* Initialize function pointers */
77 phy->ops.init_params = e1000_null_ops_generic;
78 phy->ops.acquire = e1000_null_ops_generic;
79 phy->ops.check_polarity = e1000_null_ops_generic;
80 phy->ops.check_reset_block = e1000_null_ops_generic;
81 phy->ops.commit = e1000_null_ops_generic;
82 phy->ops.force_speed_duplex = e1000_null_ops_generic;
83 phy->ops.get_cfg_done = e1000_null_ops_generic;
84 phy->ops.get_cable_length = e1000_null_ops_generic;
85 phy->ops.get_info = e1000_null_ops_generic;
86 phy->ops.set_page = e1000_null_set_page;
87 phy->ops.read_reg = e1000_null_read_reg;
88 phy->ops.read_reg_locked = e1000_null_read_reg;
89 phy->ops.read_reg_page = e1000_null_read_reg;
90 phy->ops.release = e1000_null_phy_generic;
91 phy->ops.reset = e1000_null_ops_generic;
92 phy->ops.set_d0_lplu_state = e1000_null_lplu_state;
93 phy->ops.set_d3_lplu_state = e1000_null_lplu_state;
94 phy->ops.write_reg = e1000_null_write_reg;
95 phy->ops.write_reg_locked = e1000_null_write_reg;
96 phy->ops.write_reg_page = e1000_null_write_reg;
97 phy->ops.power_up = e1000_null_phy_generic;
98 phy->ops.power_down = e1000_null_phy_generic;
99 phy->ops.read_i2c_byte = e1000_read_i2c_byte_null;
100 phy->ops.write_i2c_byte = e1000_write_i2c_byte_null;
101 phy->ops.cfg_on_link_up = e1000_null_ops_generic;
102 }
103
104 /**
105 * e1000_null_set_page - No-op function, return 0
106 * @hw: pointer to the HW structure
107 * @data: dummy variable
108 **/
109 s32 e1000_null_set_page(struct e1000_hw E1000_UNUSEDARG *hw,
110 u16 E1000_UNUSEDARG data)
111 {
112 DEBUGFUNC("e1000_null_set_page");
113 return E1000_SUCCESS;
114 }
115
116 /**
117 * e1000_null_read_reg - No-op function, return 0
118 * @hw: pointer to the HW structure
119 * @offset: dummy variable
120 * @data: dummy variable
121 **/
122 s32 e1000_null_read_reg(struct e1000_hw E1000_UNUSEDARG *hw,
123 u32 E1000_UNUSEDARG offset, u16 E1000_UNUSEDARG *data)
124 {
125 DEBUGFUNC("e1000_null_read_reg");
126 return E1000_SUCCESS;
127 }
128
129 /**
130 * e1000_null_phy_generic - No-op function, return void
131 * @hw: pointer to the HW structure
132 **/
133 void e1000_null_phy_generic(struct e1000_hw E1000_UNUSEDARG *hw)
134 {
135 DEBUGFUNC("e1000_null_phy_generic");
136 return;
137 }
138
139 /**
140 * e1000_null_lplu_state - No-op function, return 0
141 * @hw: pointer to the HW structure
142 * @active: dummy variable
143 **/
144 s32 e1000_null_lplu_state(struct e1000_hw E1000_UNUSEDARG *hw,
145 bool E1000_UNUSEDARG active)
146 {
147 DEBUGFUNC("e1000_null_lplu_state");
148 return E1000_SUCCESS;
149 }
150
151 /**
152 * e1000_null_write_reg - No-op function, return 0
153 * @hw: pointer to the HW structure
154 * @offset: dummy variable
155 * @data: dummy variable
156 **/
157 s32 e1000_null_write_reg(struct e1000_hw E1000_UNUSEDARG *hw,
158 u32 E1000_UNUSEDARG offset, u16 E1000_UNUSEDARG data)
159 {
160 DEBUGFUNC("e1000_null_write_reg");
161 return E1000_SUCCESS;
162 }
163
164 /**
165 * e1000_read_i2c_byte_null - No-op function, return 0
166 * @hw: pointer to hardware structure
167 * @byte_offset: byte offset to write
168 * @dev_addr: device address
169 * @data: data value read
170 *
171 **/
172 s32 e1000_read_i2c_byte_null(struct e1000_hw E1000_UNUSEDARG *hw,
173 u8 E1000_UNUSEDARG byte_offset,
174 u8 E1000_UNUSEDARG dev_addr,
175 u8 E1000_UNUSEDARG *data)
176 {
177 DEBUGFUNC("e1000_read_i2c_byte_null");
178 return E1000_SUCCESS;
179 }
180
181 /**
182 * e1000_write_i2c_byte_null - No-op function, return 0
183 * @hw: pointer to hardware structure
184 * @byte_offset: byte offset to write
185 * @dev_addr: device address
186 * @data: data value to write
187 *
188 **/
189 s32 e1000_write_i2c_byte_null(struct e1000_hw E1000_UNUSEDARG *hw,
190 u8 E1000_UNUSEDARG byte_offset,
191 u8 E1000_UNUSEDARG dev_addr,
192 u8 E1000_UNUSEDARG data)
193 {
194 DEBUGFUNC("e1000_write_i2c_byte_null");
195 return E1000_SUCCESS;
196 }
197
198 /**
199 * e1000_check_reset_block_generic - Check if PHY reset is blocked
200 * @hw: pointer to the HW structure
201 *
202 * Read the PHY management control register and check whether a PHY reset
203 * is blocked. If a reset is not blocked return E1000_SUCCESS, otherwise
204 * return E1000_BLK_PHY_RESET (12).
205 **/
206 s32 e1000_check_reset_block_generic(struct e1000_hw *hw)
207 {
208 u32 manc;
209
210 DEBUGFUNC("e1000_check_reset_block");
211
212 manc = E1000_READ_REG(hw, E1000_MANC);
213
214 return (manc & E1000_MANC_BLK_PHY_RST_ON_IDE) ?
215 E1000_BLK_PHY_RESET : E1000_SUCCESS;
216 }
217
218 /**
219 * e1000_get_phy_id - Retrieve the PHY ID and revision
220 * @hw: pointer to the HW structure
221 *
222 * Reads the PHY registers and stores the PHY ID and possibly the PHY
223 * revision in the hardware structure.
224 **/
225 s32 e1000_get_phy_id(struct e1000_hw *hw)
226 {
227 struct e1000_phy_info *phy = &hw->phy;
228 s32 ret_val = E1000_SUCCESS;
229 u16 phy_id;
230 u16 retry_count = 0;
231
232 DEBUGFUNC("e1000_get_phy_id");
233
234 if (!phy->ops.read_reg)
235 return E1000_SUCCESS;
236
237 while (retry_count < 2) {
238 ret_val = phy->ops.read_reg(hw, PHY_ID1, &phy_id);
239 if (ret_val)
240 return ret_val;
241
242 phy->id = (u32)(phy_id << 16);
243 usec_delay(20);
244 ret_val = phy->ops.read_reg(hw, PHY_ID2, &phy_id);
245 if (ret_val)
246 return ret_val;
247
248 phy->id |= (u32)(phy_id & PHY_REVISION_MASK);
249 phy->revision = (u32)(phy_id & ~PHY_REVISION_MASK);
250
251 if (phy->id != 0 && phy->id != PHY_REVISION_MASK)
252 return E1000_SUCCESS;
253
254 retry_count++;
255 }
256
257 return E1000_SUCCESS;
258 }
259
260 /**
261 * e1000_phy_reset_dsp_generic - Reset PHY DSP
262 * @hw: pointer to the HW structure
263 *
264 * Reset the digital signal processor.
265 **/
266 s32 e1000_phy_reset_dsp_generic(struct e1000_hw *hw)
267 {
268 s32 ret_val;
269
270 DEBUGFUNC("e1000_phy_reset_dsp_generic");
271
272 if (!hw->phy.ops.write_reg)
273 return E1000_SUCCESS;
274
275 ret_val = hw->phy.ops.write_reg(hw, M88E1000_PHY_GEN_CONTROL, 0xC1);
276 if (ret_val)
277 return ret_val;
278
279 return hw->phy.ops.write_reg(hw, M88E1000_PHY_GEN_CONTROL, 0);
280 }
281
282 /**
283 * e1000_read_phy_reg_mdic - Read MDI control register
284 * @hw: pointer to the HW structure
285 * @offset: register offset to be read
286 * @data: pointer to the read data
287 *
288 * Reads the MDI control register in the PHY at offset and stores the
289 * information read to data.
290 **/
291 s32 e1000_read_phy_reg_mdic(struct e1000_hw *hw, u32 offset, u16 *data)
292 {
293 struct e1000_phy_info *phy = &hw->phy;
294 u32 i, mdic = 0;
295
296 DEBUGFUNC("e1000_read_phy_reg_mdic");
297
298 if (offset > MAX_PHY_REG_ADDRESS) {
299 DEBUGOUT1("PHY Address %d is out of range\n", offset);
300 return -E1000_ERR_PARAM;
301 }
302
303 /* Set up Op-code, Phy Address, and register offset in the MDI
304 * Control register. The MAC will take care of interfacing with the
305 * PHY to retrieve the desired data.
306 */
307 mdic = ((offset << E1000_MDIC_REG_SHIFT) |
308 (phy->addr << E1000_MDIC_PHY_SHIFT) |
309 (E1000_MDIC_OP_READ));
310
311 E1000_WRITE_REG(hw, E1000_MDIC, mdic);
312
313 /* Poll the ready bit to see if the MDI read completed
314 * Increasing the time out as testing showed failures with
315 * the lower time out
316 */
317 for (i = 0; i < (E1000_GEN_POLL_TIMEOUT * 3); i++) {
318 usec_delay_irq(50);
319 mdic = E1000_READ_REG(hw, E1000_MDIC);
320 if (mdic & E1000_MDIC_READY)
321 break;
322 }
323 if (!(mdic & E1000_MDIC_READY)) {
324 DEBUGOUT("MDI Read did not complete\n");
325 return -E1000_ERR_PHY;
326 }
327 if (mdic & E1000_MDIC_ERROR) {
328 DEBUGOUT("MDI Error\n");
329 return -E1000_ERR_PHY;
330 }
331 if (((mdic & E1000_MDIC_REG_MASK) >> E1000_MDIC_REG_SHIFT) != offset) {
332 DEBUGOUT2("MDI Read offset error - requested %d, returned %d\n",
333 offset,
334 (mdic & E1000_MDIC_REG_MASK) >> E1000_MDIC_REG_SHIFT);
335 return -E1000_ERR_PHY;
336 }
337 *data = (u16) mdic;
338
339 /* Allow some time after each MDIC transaction to avoid
340 * reading duplicate data in the next MDIC transaction.
341 */
342 if (hw->mac.type == e1000_pch2lan)
343 usec_delay_irq(100);
344
345 return E1000_SUCCESS;
346 }
347
348 /**
349 * e1000_write_phy_reg_mdic - Write MDI control register
350 * @hw: pointer to the HW structure
351 * @offset: register offset to write to
352 * @data: data to write to register at offset
353 *
354 * Writes data to MDI control register in the PHY at offset.
355 **/
356 s32 e1000_write_phy_reg_mdic(struct e1000_hw *hw, u32 offset, u16 data)
357 {
358 struct e1000_phy_info *phy = &hw->phy;
359 u32 i, mdic = 0;
360
361 DEBUGFUNC("e1000_write_phy_reg_mdic");
362
363 if (offset > MAX_PHY_REG_ADDRESS) {
364 DEBUGOUT1("PHY Address %d is out of range\n", offset);
365 return -E1000_ERR_PARAM;
366 }
367
368 /* Set up Op-code, Phy Address, and register offset in the MDI
369 * Control register. The MAC will take care of interfacing with the
370 * PHY to retrieve the desired data.
371 */
372 mdic = (((u32)data) |
373 (offset << E1000_MDIC_REG_SHIFT) |
374 (phy->addr << E1000_MDIC_PHY_SHIFT) |
375 (E1000_MDIC_OP_WRITE));
376
377 E1000_WRITE_REG(hw, E1000_MDIC, mdic);
378
379 /* Poll the ready bit to see if the MDI read completed
380 * Increasing the time out as testing showed failures with
381 * the lower time out
382 */
383 for (i = 0; i < (E1000_GEN_POLL_TIMEOUT * 3); i++) {
384 usec_delay_irq(50);
385 mdic = E1000_READ_REG(hw, E1000_MDIC);
386 if (mdic & E1000_MDIC_READY)
387 break;
388 }
389 if (!(mdic & E1000_MDIC_READY)) {
390 DEBUGOUT("MDI Write did not complete\n");
391 return -E1000_ERR_PHY;
392 }
393 if (mdic & E1000_MDIC_ERROR) {
394 DEBUGOUT("MDI Error\n");
395 return -E1000_ERR_PHY;
396 }
397 if (((mdic & E1000_MDIC_REG_MASK) >> E1000_MDIC_REG_SHIFT) != offset) {
398 DEBUGOUT2("MDI Write offset error - requested %d, returned %d\n",
399 offset,
400 (mdic & E1000_MDIC_REG_MASK) >> E1000_MDIC_REG_SHIFT);
401 return -E1000_ERR_PHY;
402 }
403
404 /* Allow some time after each MDIC transaction to avoid
405 * reading duplicate data in the next MDIC transaction.
406 */
407 if (hw->mac.type == e1000_pch2lan)
408 usec_delay_irq(100);
409
410 return E1000_SUCCESS;
411 }
412
413 /**
414 * e1000_read_phy_reg_i2c - Read PHY register using i2c
415 * @hw: pointer to the HW structure
416 * @offset: register offset to be read
417 * @data: pointer to the read data
418 *
419 * Reads the PHY register at offset using the i2c interface and stores the
420 * retrieved information in data.
421 **/
422 s32 e1000_read_phy_reg_i2c(struct e1000_hw *hw, u32 offset, u16 *data)
423 {
424 struct e1000_phy_info *phy = &hw->phy;
425 u32 i, i2ccmd = 0;
426
427 DEBUGFUNC("e1000_read_phy_reg_i2c");
428
429 /* Set up Op-code, Phy Address, and register address in the I2CCMD
430 * register. The MAC will take care of interfacing with the
431 * PHY to retrieve the desired data.
432 */
433 i2ccmd = ((offset << E1000_I2CCMD_REG_ADDR_SHIFT) |
434 (phy->addr << E1000_I2CCMD_PHY_ADDR_SHIFT) |
435 (E1000_I2CCMD_OPCODE_READ));
436
437 E1000_WRITE_REG(hw, E1000_I2CCMD, i2ccmd);
438
439 /* Poll the ready bit to see if the I2C read completed */
440 for (i = 0; i < E1000_I2CCMD_PHY_TIMEOUT; i++) {
441 usec_delay(50);
442 i2ccmd = E1000_READ_REG(hw, E1000_I2CCMD);
443 if (i2ccmd & E1000_I2CCMD_READY)
444 break;
445 }
446 if (!(i2ccmd & E1000_I2CCMD_READY)) {
447 DEBUGOUT("I2CCMD Read did not complete\n");
448 return -E1000_ERR_PHY;
449 }
450 if (i2ccmd & E1000_I2CCMD_ERROR) {
451 DEBUGOUT("I2CCMD Error bit set\n");
452 return -E1000_ERR_PHY;
453 }
454
455 /* Need to byte-swap the 16-bit value. */
456 *data = ((i2ccmd >> 8) & 0x00FF) | ((i2ccmd << 8) & 0xFF00);
457
458 return E1000_SUCCESS;
459 }
460
461 /**
462 * e1000_write_phy_reg_i2c - Write PHY register using i2c
463 * @hw: pointer to the HW structure
464 * @offset: register offset to write to
465 * @data: data to write at register offset
466 *
467 * Writes the data to PHY register at the offset using the i2c interface.
468 **/
469 s32 e1000_write_phy_reg_i2c(struct e1000_hw *hw, u32 offset, u16 data)
470 {
471 struct e1000_phy_info *phy = &hw->phy;
472 u32 i, i2ccmd = 0;
473 u16 phy_data_swapped;
474
475 DEBUGFUNC("e1000_write_phy_reg_i2c");
476
477 /* Prevent overwriting SFP I2C EEPROM which is at A0 address.*/
478 if ((hw->phy.addr == 0) || (hw->phy.addr > 7)) {
479 DEBUGOUT1("PHY I2C Address %d is out of range.\n",
480 hw->phy.addr);
481 return -E1000_ERR_CONFIG;
482 }
483
484 /* Swap the data bytes for the I2C interface */
485 phy_data_swapped = ((data >> 8) & 0x00FF) | ((data << 8) & 0xFF00);
486
487 /* Set up Op-code, Phy Address, and register address in the I2CCMD
488 * register. The MAC will take care of interfacing with the
489 * PHY to retrieve the desired data.
490 */
491 i2ccmd = ((offset << E1000_I2CCMD_REG_ADDR_SHIFT) |
492 (phy->addr << E1000_I2CCMD_PHY_ADDR_SHIFT) |
493 E1000_I2CCMD_OPCODE_WRITE |
494 phy_data_swapped);
495
496 E1000_WRITE_REG(hw, E1000_I2CCMD, i2ccmd);
497
498 /* Poll the ready bit to see if the I2C read completed */
499 for (i = 0; i < E1000_I2CCMD_PHY_TIMEOUT; i++) {
500 usec_delay(50);
501 i2ccmd = E1000_READ_REG(hw, E1000_I2CCMD);
502 if (i2ccmd & E1000_I2CCMD_READY)
503 break;
504 }
505 if (!(i2ccmd & E1000_I2CCMD_READY)) {
506 DEBUGOUT("I2CCMD Write did not complete\n");
507 return -E1000_ERR_PHY;
508 }
509 if (i2ccmd & E1000_I2CCMD_ERROR) {
510 DEBUGOUT("I2CCMD Error bit set\n");
511 return -E1000_ERR_PHY;
512 }
513
514 return E1000_SUCCESS;
515 }
516
517 /**
518 * e1000_read_sfp_data_byte - Reads SFP module data.
519 * @hw: pointer to the HW structure
520 * @offset: byte location offset to be read
521 * @data: read data buffer pointer
522 *
523 * Reads one byte from SFP module data stored
524 * in SFP resided EEPROM memory or SFP diagnostic area.
525 * Function should be called with
526 * E1000_I2CCMD_SFP_DATA_ADDR(<byte offset>) for SFP module database access
527 * E1000_I2CCMD_SFP_DIAG_ADDR(<byte offset>) for SFP diagnostics parameters
528 * access
529 **/
530 s32 e1000_read_sfp_data_byte(struct e1000_hw *hw, u16 offset, u8 *data)
531 {
532 u32 i = 0;
533 u32 i2ccmd = 0;
534 u32 data_local = 0;
535
536 DEBUGFUNC("e1000_read_sfp_data_byte");
537
538 if (offset > E1000_I2CCMD_SFP_DIAG_ADDR(255)) {
539 DEBUGOUT("I2CCMD command address exceeds upper limit\n");
540 return -E1000_ERR_PHY;
541 }
542
543 /* Set up Op-code, EEPROM Address,in the I2CCMD
544 * register. The MAC will take care of interfacing with the
545 * EEPROM to retrieve the desired data.
546 */
547 i2ccmd = ((offset << E1000_I2CCMD_REG_ADDR_SHIFT) |
548 E1000_I2CCMD_OPCODE_READ);
549
550 E1000_WRITE_REG(hw, E1000_I2CCMD, i2ccmd);
551
552 /* Poll the ready bit to see if the I2C read completed */
553 for (i = 0; i < E1000_I2CCMD_PHY_TIMEOUT; i++) {
554 usec_delay(50);
555 data_local = E1000_READ_REG(hw, E1000_I2CCMD);
556 if (data_local & E1000_I2CCMD_READY)
557 break;
558 }
559 if (!(data_local & E1000_I2CCMD_READY)) {
560 DEBUGOUT("I2CCMD Read did not complete\n");
561 return -E1000_ERR_PHY;
562 }
563 if (data_local & E1000_I2CCMD_ERROR) {
564 DEBUGOUT("I2CCMD Error bit set\n");
565 return -E1000_ERR_PHY;
566 }
567 *data = (u8) data_local & 0xFF;
568
569 return E1000_SUCCESS;
570 }
571
572 /**
573 * e1000_write_sfp_data_byte - Writes SFP module data.
574 * @hw: pointer to the HW structure
575 * @offset: byte location offset to write to
576 * @data: data to write
577 *
578 * Writes one byte to SFP module data stored
579 * in SFP resided EEPROM memory or SFP diagnostic area.
580 * Function should be called with
581 * E1000_I2CCMD_SFP_DATA_ADDR(<byte offset>) for SFP module database access
582 * E1000_I2CCMD_SFP_DIAG_ADDR(<byte offset>) for SFP diagnostics parameters
583 * access
584 **/
585 s32 e1000_write_sfp_data_byte(struct e1000_hw *hw, u16 offset, u8 data)
586 {
587 u32 i = 0;
588 u32 i2ccmd = 0;
589 u32 data_local = 0;
590
591 DEBUGFUNC("e1000_write_sfp_data_byte");
592
593 if (offset > E1000_I2CCMD_SFP_DIAG_ADDR(255)) {
594 DEBUGOUT("I2CCMD command address exceeds upper limit\n");
595 return -E1000_ERR_PHY;
596 }
597 /* The programming interface is 16 bits wide
598 * so we need to read the whole word first
599 * then update appropriate byte lane and write
600 * the updated word back.
601 */
602 /* Set up Op-code, EEPROM Address,in the I2CCMD
603 * register. The MAC will take care of interfacing
604 * with an EEPROM to write the data given.
605 */
606 i2ccmd = ((offset << E1000_I2CCMD_REG_ADDR_SHIFT) |
607 E1000_I2CCMD_OPCODE_READ);
608 /* Set a command to read single word */
609 E1000_WRITE_REG(hw, E1000_I2CCMD, i2ccmd);
610 for (i = 0; i < E1000_I2CCMD_PHY_TIMEOUT; i++) {
611 usec_delay(50);
612 /* Poll the ready bit to see if lastly
613 * launched I2C operation completed
614 */
615 i2ccmd = E1000_READ_REG(hw, E1000_I2CCMD);
616 if (i2ccmd & E1000_I2CCMD_READY) {
617 /* Check if this is READ or WRITE phase */
618 if ((i2ccmd & E1000_I2CCMD_OPCODE_READ) ==
619 E1000_I2CCMD_OPCODE_READ) {
620 /* Write the selected byte
621 * lane and update whole word
622 */
623 data_local = i2ccmd & 0xFF00;
624 data_local |= (u32)data;
625 i2ccmd = ((offset <<
626 E1000_I2CCMD_REG_ADDR_SHIFT) |
627 E1000_I2CCMD_OPCODE_WRITE | data_local);
628 E1000_WRITE_REG(hw, E1000_I2CCMD, i2ccmd);
629 } else {
630 break;
631 }
632 }
633 }
634 if (!(i2ccmd & E1000_I2CCMD_READY)) {
635 DEBUGOUT("I2CCMD Write did not complete\n");
636 return -E1000_ERR_PHY;
637 }
638 if (i2ccmd & E1000_I2CCMD_ERROR) {
639 DEBUGOUT("I2CCMD Error bit set\n");
640 return -E1000_ERR_PHY;
641 }
642 return E1000_SUCCESS;
643 }
644
645 /**
646 * e1000_read_phy_reg_m88 - Read m88 PHY register
647 * @hw: pointer to the HW structure
648 * @offset: register offset to be read
649 * @data: pointer to the read data
650 *
651 * Acquires semaphore, if necessary, then reads the PHY register at offset
652 * and storing the retrieved information in data. Release any acquired
653 * semaphores before exiting.
654 **/
655 s32 e1000_read_phy_reg_m88(struct e1000_hw *hw, u32 offset, u16 *data)
656 {
657 s32 ret_val;
658
659 DEBUGFUNC("e1000_read_phy_reg_m88");
660
661 if (!hw->phy.ops.acquire)
662 return E1000_SUCCESS;
663
664 ret_val = hw->phy.ops.acquire(hw);
665 if (ret_val)
666 return ret_val;
667
668 ret_val = e1000_read_phy_reg_mdic(hw, MAX_PHY_REG_ADDRESS & offset,
669 data);
670
671 hw->phy.ops.release(hw);
672
673 return ret_val;
674 }
675
676 /**
677 * e1000_write_phy_reg_m88 - Write m88 PHY register
678 * @hw: pointer to the HW structure
679 * @offset: register offset to write to
680 * @data: data to write at register offset
681 *
682 * Acquires semaphore, if necessary, then writes the data to PHY register
683 * at the offset. Release any acquired semaphores before exiting.
684 **/
685 s32 e1000_write_phy_reg_m88(struct e1000_hw *hw, u32 offset, u16 data)
686 {
687 s32 ret_val;
688
689 DEBUGFUNC("e1000_write_phy_reg_m88");
690
691 if (!hw->phy.ops.acquire)
692 return E1000_SUCCESS;
693
694 ret_val = hw->phy.ops.acquire(hw);
695 if (ret_val)
696 return ret_val;
697
698 ret_val = e1000_write_phy_reg_mdic(hw, MAX_PHY_REG_ADDRESS & offset,
699 data);
700
701 hw->phy.ops.release(hw);
702
703 return ret_val;
704 }
705
706 /**
707 * e1000_set_page_igp - Set page as on IGP-like PHY(s)
708 * @hw: pointer to the HW structure
709 * @page: page to set (shifted left when necessary)
710 *
711 * Sets PHY page required for PHY register access. Assumes semaphore is
712 * already acquired. Note, this function sets phy.addr to 1 so the caller
713 * must set it appropriately (if necessary) after this function returns.
714 **/
715 s32 e1000_set_page_igp(struct e1000_hw *hw, u16 page)
716 {
717 DEBUGFUNC("e1000_set_page_igp");
718
719 DEBUGOUT1("Setting page 0x%x\n", page);
720
721 hw->phy.addr = 1;
722
723 return e1000_write_phy_reg_mdic(hw, IGP01E1000_PHY_PAGE_SELECT, page);
724 }
725
726 /**
727 * __e1000_read_phy_reg_igp - Read igp PHY register
728 * @hw: pointer to the HW structure
729 * @offset: register offset to be read
730 * @data: pointer to the read data
731 * @locked: semaphore has already been acquired or not
732 *
733 * Acquires semaphore, if necessary, then reads the PHY register at offset
734 * and stores the retrieved information in data. Release any acquired
735 * semaphores before exiting.
736 **/
737 static s32 __e1000_read_phy_reg_igp(struct e1000_hw *hw, u32 offset, u16 *data,
738 bool locked)
739 {
740 s32 ret_val = E1000_SUCCESS;
741
742 DEBUGFUNC("__e1000_read_phy_reg_igp");
743
744 if (!locked) {
745 if (!hw->phy.ops.acquire)
746 return E1000_SUCCESS;
747
748 ret_val = hw->phy.ops.acquire(hw);
749 if (ret_val)
750 return ret_val;
751 }
752
753 if (offset > MAX_PHY_MULTI_PAGE_REG)
754 ret_val = e1000_write_phy_reg_mdic(hw,
755 IGP01E1000_PHY_PAGE_SELECT,
756 (u16)offset);
757 if (!ret_val)
758 ret_val = e1000_read_phy_reg_mdic(hw,
759 MAX_PHY_REG_ADDRESS & offset,
760 data);
761 if (!locked)
762 hw->phy.ops.release(hw);
763
764 return ret_val;
765 }
766
767 /**
768 * e1000_read_phy_reg_igp - Read igp PHY register
769 * @hw: pointer to the HW structure
770 * @offset: register offset to be read
771 * @data: pointer to the read data
772 *
773 * Acquires semaphore then reads the PHY register at offset and stores the
774 * retrieved information in data.
775 * Release the acquired semaphore before exiting.
776 **/
777 s32 e1000_read_phy_reg_igp(struct e1000_hw *hw, u32 offset, u16 *data)
778 {
779 return __e1000_read_phy_reg_igp(hw, offset, data, false);
780 }
781
782 /**
783 * e1000_read_phy_reg_igp_locked - Read igp PHY register
784 * @hw: pointer to the HW structure
785 * @offset: register offset to be read
786 * @data: pointer to the read data
787 *
788 * Reads the PHY register at offset and stores the retrieved information
789 * in data. Assumes semaphore already acquired.
790 **/
791 s32 e1000_read_phy_reg_igp_locked(struct e1000_hw *hw, u32 offset, u16 *data)
792 {
793 return __e1000_read_phy_reg_igp(hw, offset, data, true);
794 }
795
796 /**
797 * e1000_write_phy_reg_igp - Write igp PHY register
798 * @hw: pointer to the HW structure
799 * @offset: register offset to write to
800 * @data: data to write at register offset
801 * @locked: semaphore has already been acquired or not
802 *
803 * Acquires semaphore, if necessary, then writes the data to PHY register
804 * at the offset. Release any acquired semaphores before exiting.
805 **/
806 static s32 __e1000_write_phy_reg_igp(struct e1000_hw *hw, u32 offset, u16 data,
807 bool locked)
808 {
809 s32 ret_val = E1000_SUCCESS;
810
811 DEBUGFUNC("e1000_write_phy_reg_igp");
812
813 if (!locked) {
814 if (!hw->phy.ops.acquire)
815 return E1000_SUCCESS;
816
817 ret_val = hw->phy.ops.acquire(hw);
818 if (ret_val)
819 return ret_val;
820 }
821
822 if (offset > MAX_PHY_MULTI_PAGE_REG)
823 ret_val = e1000_write_phy_reg_mdic(hw,
824 IGP01E1000_PHY_PAGE_SELECT,
825 (u16)offset);
826 if (!ret_val)
827 ret_val = e1000_write_phy_reg_mdic(hw, MAX_PHY_REG_ADDRESS &
828 offset,
829 data);
830 if (!locked)
831 hw->phy.ops.release(hw);
832
833 return ret_val;
834 }
835
836 /**
837 * e1000_write_phy_reg_igp - Write igp PHY register
838 * @hw: pointer to the HW structure
839 * @offset: register offset to write to
840 * @data: data to write at register offset
841 *
842 * Acquires semaphore then writes the data to PHY register
843 * at the offset. Release any acquired semaphores before exiting.
844 **/
845 s32 e1000_write_phy_reg_igp(struct e1000_hw *hw, u32 offset, u16 data)
846 {
847 return __e1000_write_phy_reg_igp(hw, offset, data, false);
848 }
849
850 /**
851 * e1000_write_phy_reg_igp_locked - Write igp PHY register
852 * @hw: pointer to the HW structure
853 * @offset: register offset to write to
854 * @data: data to write at register offset
855 *
856 * Writes the data to PHY register at the offset.
857 * Assumes semaphore already acquired.
858 **/
859 s32 e1000_write_phy_reg_igp_locked(struct e1000_hw *hw, u32 offset, u16 data)
860 {
861 return __e1000_write_phy_reg_igp(hw, offset, data, true);
862 }
863
864 /**
865 * __e1000_read_kmrn_reg - Read kumeran register
866 * @hw: pointer to the HW structure
867 * @offset: register offset to be read
868 * @data: pointer to the read data
869 * @locked: semaphore has already been acquired or not
870 *
871 * Acquires semaphore, if necessary. Then reads the PHY register at offset
872 * using the kumeran interface. The information retrieved is stored in data.
873 * Release any acquired semaphores before exiting.
874 **/
875 static s32 __e1000_read_kmrn_reg(struct e1000_hw *hw, u32 offset, u16 *data,
876 bool locked)
877 {
878 u32 kmrnctrlsta;
879
880 DEBUGFUNC("__e1000_read_kmrn_reg");
881
882 if (!locked) {
883 s32 ret_val = E1000_SUCCESS;
884
885 if (!hw->phy.ops.acquire)
886 return E1000_SUCCESS;
887
888 ret_val = hw->phy.ops.acquire(hw);
889 if (ret_val)
890 return ret_val;
891 }
892
893 kmrnctrlsta = ((offset << E1000_KMRNCTRLSTA_OFFSET_SHIFT) &
894 E1000_KMRNCTRLSTA_OFFSET) | E1000_KMRNCTRLSTA_REN;
895 E1000_WRITE_REG(hw, E1000_KMRNCTRLSTA, kmrnctrlsta);
896 E1000_WRITE_FLUSH(hw);
897
898 usec_delay(2);
899
900 kmrnctrlsta = E1000_READ_REG(hw, E1000_KMRNCTRLSTA);
901 *data = (u16)kmrnctrlsta;
902
903 if (!locked)
904 hw->phy.ops.release(hw);
905
906 return E1000_SUCCESS;
907 }
908
909 /**
910 * e1000_read_kmrn_reg_generic - Read kumeran register
911 * @hw: pointer to the HW structure
912 * @offset: register offset to be read
913 * @data: pointer to the read data
914 *
915 * Acquires semaphore then reads the PHY register at offset using the
916 * kumeran interface. The information retrieved is stored in data.
917 * Release the acquired semaphore before exiting.
918 **/
919 s32 e1000_read_kmrn_reg_generic(struct e1000_hw *hw, u32 offset, u16 *data)
920 {
921 return __e1000_read_kmrn_reg(hw, offset, data, false);
922 }
923
924 /**
925 * e1000_read_kmrn_reg_locked - Read kumeran register
926 * @hw: pointer to the HW structure
927 * @offset: register offset to be read
928 * @data: pointer to the read data
929 *
930 * Reads the PHY register at offset using the kumeran interface. The
931 * information retrieved is stored in data.
932 * Assumes semaphore already acquired.
933 **/
934 s32 e1000_read_kmrn_reg_locked(struct e1000_hw *hw, u32 offset, u16 *data)
935 {
936 return __e1000_read_kmrn_reg(hw, offset, data, true);
937 }
938
939 /**
940 * __e1000_write_kmrn_reg - Write kumeran register
941 * @hw: pointer to the HW structure
942 * @offset: register offset to write to
943 * @data: data to write at register offset
944 * @locked: semaphore has already been acquired or not
945 *
946 * Acquires semaphore, if necessary. Then write the data to PHY register
947 * at the offset using the kumeran interface. Release any acquired semaphores
948 * before exiting.
949 **/
950 static s32 __e1000_write_kmrn_reg(struct e1000_hw *hw, u32 offset, u16 data,
951 bool locked)
952 {
953 u32 kmrnctrlsta;
954
955 DEBUGFUNC("e1000_write_kmrn_reg_generic");
956
957 if (!locked) {
958 s32 ret_val = E1000_SUCCESS;
959
960 if (!hw->phy.ops.acquire)
961 return E1000_SUCCESS;
962
963 ret_val = hw->phy.ops.acquire(hw);
964 if (ret_val)
965 return ret_val;
966 }
967
968 kmrnctrlsta = ((offset << E1000_KMRNCTRLSTA_OFFSET_SHIFT) &
969 E1000_KMRNCTRLSTA_OFFSET) | data;
970 E1000_WRITE_REG(hw, E1000_KMRNCTRLSTA, kmrnctrlsta);
971 E1000_WRITE_FLUSH(hw);
972
973 usec_delay(2);
974
975 if (!locked)
976 hw->phy.ops.release(hw);
977
978 return E1000_SUCCESS;
979 }
980
981 /**
982 * e1000_write_kmrn_reg_generic - Write kumeran register
983 * @hw: pointer to the HW structure
984 * @offset: register offset to write to
985 * @data: data to write at register offset
986 *
987 * Acquires semaphore then writes the data to the PHY register at the offset
988 * using the kumeran interface. Release the acquired semaphore before exiting.
989 **/
990 s32 e1000_write_kmrn_reg_generic(struct e1000_hw *hw, u32 offset, u16 data)
991 {
992 return __e1000_write_kmrn_reg(hw, offset, data, false);
993 }
994
995 /**
996 * e1000_write_kmrn_reg_locked - Write kumeran register
997 * @hw: pointer to the HW structure
998 * @offset: register offset to write to
999 * @data: data to write at register offset
1000 *
1001 * Write the data to PHY register at the offset using the kumeran interface.
1002 * Assumes semaphore already acquired.
1003 **/
1004 s32 e1000_write_kmrn_reg_locked(struct e1000_hw *hw, u32 offset, u16 data)
1005 {
1006 return __e1000_write_kmrn_reg(hw, offset, data, true);
1007 }
1008
1009 /**
1010 * e1000_set_master_slave_mode - Setup PHY for Master/slave mode
1011 * @hw: pointer to the HW structure
1012 *
1013 * Sets up Master/slave mode
1014 **/
1015 static s32 e1000_set_master_slave_mode(struct e1000_hw *hw)
1016 {
1017 s32 ret_val;
1018 u16 phy_data;
1019
1020 /* Resolve Master/Slave mode */
1021 ret_val = hw->phy.ops.read_reg(hw, PHY_1000T_CTRL, &phy_data);
1022 if (ret_val)
1023 return ret_val;
1024
1025 /* load defaults for future use */
1026 hw->phy.original_ms_type = (phy_data & CR_1000T_MS_ENABLE) ?
1027 ((phy_data & CR_1000T_MS_VALUE) ?
1028 e1000_ms_force_master :
1029 e1000_ms_force_slave) : e1000_ms_auto;
1030
1031 switch (hw->phy.ms_type) {
1032 case e1000_ms_force_master:
1033 phy_data |= (CR_1000T_MS_ENABLE | CR_1000T_MS_VALUE);
1034 break;
1035 case e1000_ms_force_slave:
1036 phy_data |= CR_1000T_MS_ENABLE;
1037 phy_data &= ~(CR_1000T_MS_VALUE);
1038 break;
1039 case e1000_ms_auto:
1040 phy_data &= ~CR_1000T_MS_ENABLE;
1041 /* FALLTHROUGH */
1042 default:
1043 break;
1044 }
1045
1046 return hw->phy.ops.write_reg(hw, PHY_1000T_CTRL, phy_data);
1047 }
1048
1049 /**
1050 * e1000_copper_link_setup_82577 - Setup 82577 PHY for copper link
1051 * @hw: pointer to the HW structure
1052 *
1053 * Sets up Carrier-sense on Transmit and downshift values.
1054 **/
1055 s32 e1000_copper_link_setup_82577(struct e1000_hw *hw)
1056 {
1057 s32 ret_val;
1058 u16 phy_data;
1059
1060 DEBUGFUNC("e1000_copper_link_setup_82577");
1061
1062 if (hw->phy.type == e1000_phy_82580) {
1063 ret_val = hw->phy.ops.reset(hw);
1064 if (ret_val) {
1065 DEBUGOUT("Error resetting the PHY.\n");
1066 return ret_val;
1067 }
1068 }
1069
1070 /* Enable CRS on Tx. This must be set for half-duplex operation. */
1071 ret_val = hw->phy.ops.read_reg(hw, I82577_CFG_REG, &phy_data);
1072 if (ret_val)
1073 return ret_val;
1074
1075 phy_data |= I82577_CFG_ASSERT_CRS_ON_TX;
1076
1077 /* Enable downshift */
1078 phy_data |= I82577_CFG_ENABLE_DOWNSHIFT;
1079
1080 ret_val = hw->phy.ops.write_reg(hw, I82577_CFG_REG, phy_data);
1081 if (ret_val)
1082 return ret_val;
1083
1084 /* Set MDI/MDIX mode */
1085 ret_val = hw->phy.ops.read_reg(hw, I82577_PHY_CTRL_2, &phy_data);
1086 if (ret_val)
1087 return ret_val;
1088 phy_data &= ~I82577_PHY_CTRL2_MDIX_CFG_MASK;
1089 /* Options:
1090 * 0 - Auto (default)
1091 * 1 - MDI mode
1092 * 2 - MDI-X mode
1093 */
1094 switch (hw->phy.mdix) {
1095 case 1:
1096 break;
1097 case 2:
1098 phy_data |= I82577_PHY_CTRL2_MANUAL_MDIX;
1099 break;
1100 case 0:
1101 /* FALLTHROUGH */
1102 default:
1103 phy_data |= I82577_PHY_CTRL2_AUTO_MDI_MDIX;
1104 break;
1105 }
1106 ret_val = hw->phy.ops.write_reg(hw, I82577_PHY_CTRL_2, phy_data);
1107 if (ret_val)
1108 return ret_val;
1109
1110 return e1000_set_master_slave_mode(hw);
1111 }
1112
1113 /**
1114 * e1000_copper_link_setup_m88 - Setup m88 PHY's for copper link
1115 * @hw: pointer to the HW structure
1116 *
1117 * Sets up MDI/MDI-X and polarity for m88 PHY's. If necessary, transmit clock
1118 * and downshift values are set also.
1119 **/
1120 s32 e1000_copper_link_setup_m88(struct e1000_hw *hw)
1121 {
1122 struct e1000_phy_info *phy = &hw->phy;
1123 s32 ret_val;
1124 u16 phy_data;
1125
1126 DEBUGFUNC("e1000_copper_link_setup_m88");
1127
1128
1129 /* Enable CRS on Tx. This must be set for half-duplex operation. */
1130 ret_val = phy->ops.read_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
1131 if (ret_val)
1132 return ret_val;
1133
1134 /* For BM PHY this bit is downshift enable */
1135 if (phy->type != e1000_phy_bm)
1136 phy_data |= M88E1000_PSCR_ASSERT_CRS_ON_TX;
1137
1138 /* Options:
1139 * MDI/MDI-X = 0 (default)
1140 * 0 - Auto for all speeds
1141 * 1 - MDI mode
1142 * 2 - MDI-X mode
1143 * 3 - Auto for 1000Base-T only (MDI-X for 10/100Base-T modes)
1144 */
1145 phy_data &= ~M88E1000_PSCR_AUTO_X_MODE;
1146
1147 switch (phy->mdix) {
1148 case 1:
1149 phy_data |= M88E1000_PSCR_MDI_MANUAL_MODE;
1150 break;
1151 case 2:
1152 phy_data |= M88E1000_PSCR_MDIX_MANUAL_MODE;
1153 break;
1154 case 3:
1155 phy_data |= M88E1000_PSCR_AUTO_X_1000T;
1156 break;
1157 case 0:
1158 /* FALLTHROUGH */
1159 default:
1160 phy_data |= M88E1000_PSCR_AUTO_X_MODE;
1161 break;
1162 }
1163
1164 /* Options:
1165 * disable_polarity_correction = 0 (default)
1166 * Automatic Correction for Reversed Cable Polarity
1167 * 0 - Disabled
1168 * 1 - Enabled
1169 */
1170 phy_data &= ~M88E1000_PSCR_POLARITY_REVERSAL;
1171 if (phy->disable_polarity_correction)
1172 phy_data |= M88E1000_PSCR_POLARITY_REVERSAL;
1173
1174 /* Enable downshift on BM (disabled by default) */
1175 if (phy->type == e1000_phy_bm) {
1176 /* For 82574/82583, first disable then enable downshift */
1177 if (phy->id == BME1000_E_PHY_ID_R2) {
1178 phy_data &= ~BME1000_PSCR_ENABLE_DOWNSHIFT;
1179 ret_val = phy->ops.write_reg(hw, M88E1000_PHY_SPEC_CTRL,
1180 phy_data);
1181 if (ret_val)
1182 return ret_val;
1183 /* Commit the changes. */
1184 ret_val = phy->ops.commit(hw);
1185 if (ret_val) {
1186 DEBUGOUT("Error committing the PHY changes\n");
1187 return ret_val;
1188 }
1189 }
1190
1191 phy_data |= BME1000_PSCR_ENABLE_DOWNSHIFT;
1192 }
1193
1194 ret_val = phy->ops.write_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
1195 if (ret_val)
1196 return ret_val;
1197
1198 if ((phy->type == e1000_phy_m88) &&
1199 (phy->revision < E1000_REVISION_4) &&
1200 (phy->id != BME1000_E_PHY_ID_R2)) {
1201 /* Force TX_CLK in the Extended PHY Specific Control Register
1202 * to 25MHz clock.
1203 */
1204 ret_val = phy->ops.read_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL,
1205 &phy_data);
1206 if (ret_val)
1207 return ret_val;
1208
1209 phy_data |= M88E1000_EPSCR_TX_CLK_25;
1210
1211 if ((phy->revision == E1000_REVISION_2) &&
1212 (phy->id == M88E1111_I_PHY_ID)) {
1213 /* 82573L PHY - set the downshift counter to 5x. */
1214 phy_data &= ~M88EC018_EPSCR_DOWNSHIFT_COUNTER_MASK;
1215 phy_data |= M88EC018_EPSCR_DOWNSHIFT_COUNTER_5X;
1216 } else {
1217 /* Configure Master and Slave downshift values */
1218 phy_data &= ~(M88E1000_EPSCR_MASTER_DOWNSHIFT_MASK |
1219 M88E1000_EPSCR_SLAVE_DOWNSHIFT_MASK);
1220 phy_data |= (M88E1000_EPSCR_MASTER_DOWNSHIFT_1X |
1221 M88E1000_EPSCR_SLAVE_DOWNSHIFT_1X);
1222 }
1223 ret_val = phy->ops.write_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL,
1224 phy_data);
1225 if (ret_val)
1226 return ret_val;
1227 }
1228
1229 if ((phy->type == e1000_phy_bm) && (phy->id == BME1000_E_PHY_ID_R2)) {
1230 /* Set PHY page 0, register 29 to 0x0003 */
1231 ret_val = phy->ops.write_reg(hw, 29, 0x0003);
1232 if (ret_val)
1233 return ret_val;
1234
1235 /* Set PHY page 0, register 30 to 0x0000 */
1236 ret_val = phy->ops.write_reg(hw, 30, 0x0000);
1237 if (ret_val)
1238 return ret_val;
1239 }
1240
1241 /* Commit the changes. */
1242 ret_val = phy->ops.commit(hw);
1243 if (ret_val) {
1244 DEBUGOUT("Error committing the PHY changes\n");
1245 return ret_val;
1246 }
1247
1248 if (phy->type == e1000_phy_82578) {
1249 ret_val = phy->ops.read_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL,
1250 &phy_data);
1251 if (ret_val)
1252 return ret_val;
1253
1254 /* 82578 PHY - set the downshift count to 1x. */
1255 phy_data |= I82578_EPSCR_DOWNSHIFT_ENABLE;
1256 phy_data &= ~I82578_EPSCR_DOWNSHIFT_COUNTER_MASK;
1257 ret_val = phy->ops.write_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL,
1258 phy_data);
1259 if (ret_val)
1260 return ret_val;
1261 }
1262
1263 return E1000_SUCCESS;
1264 }
1265
1266 /**
1267 * e1000_copper_link_setup_m88_gen2 - Setup m88 PHY's for copper link
1268 * @hw: pointer to the HW structure
1269 *
1270 * Sets up MDI/MDI-X and polarity for i347-AT4, m88e1322 and m88e1112 PHY's.
1271 * Also enables and sets the downshift parameters.
1272 **/
1273 s32 e1000_copper_link_setup_m88_gen2(struct e1000_hw *hw)
1274 {
1275 struct e1000_phy_info *phy = &hw->phy;
1276 s32 ret_val;
1277 u16 phy_data;
1278
1279 DEBUGFUNC("e1000_copper_link_setup_m88_gen2");
1280
1281
1282 /* Enable CRS on Tx. This must be set for half-duplex operation. */
1283 ret_val = phy->ops.read_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
1284 if (ret_val)
1285 return ret_val;
1286
1287 /* Options:
1288 * MDI/MDI-X = 0 (default)
1289 * 0 - Auto for all speeds
1290 * 1 - MDI mode
1291 * 2 - MDI-X mode
1292 * 3 - Auto for 1000Base-T only (MDI-X for 10/100Base-T modes)
1293 */
1294 phy_data &= ~M88E1000_PSCR_AUTO_X_MODE;
1295
1296 switch (phy->mdix) {
1297 case 1:
1298 phy_data |= M88E1000_PSCR_MDI_MANUAL_MODE;
1299 break;
1300 case 2:
1301 phy_data |= M88E1000_PSCR_MDIX_MANUAL_MODE;
1302 break;
1303 case 3:
1304 /* M88E1112 does not support this mode) */
1305 if (phy->id != M88E1112_E_PHY_ID) {
1306 phy_data |= M88E1000_PSCR_AUTO_X_1000T;
1307 break;
1308 }
1309 /* FALLTHROUGH */
1310 case 0:
1311 /* FALLTHROUGH */
1312 default:
1313 phy_data |= M88E1000_PSCR_AUTO_X_MODE;
1314 break;
1315 }
1316
1317 /* Options:
1318 * disable_polarity_correction = 0 (default)
1319 * Automatic Correction for Reversed Cable Polarity
1320 * 0 - Disabled
1321 * 1 - Enabled
1322 */
1323 phy_data &= ~M88E1000_PSCR_POLARITY_REVERSAL;
1324 if (phy->disable_polarity_correction)
1325 phy_data |= M88E1000_PSCR_POLARITY_REVERSAL;
1326
1327 /* Enable downshift and setting it to X6 */
1328 if (phy->id == M88E1543_E_PHY_ID) {
1329 phy_data &= ~I347AT4_PSCR_DOWNSHIFT_ENABLE;
1330 ret_val =
1331 phy->ops.write_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
1332 if (ret_val)
1333 return ret_val;
1334
1335 ret_val = phy->ops.commit(hw);
1336 if (ret_val) {
1337 DEBUGOUT("Error committing the PHY changes\n");
1338 return ret_val;
1339 }
1340 }
1341
1342 phy_data &= ~I347AT4_PSCR_DOWNSHIFT_MASK;
1343 phy_data |= I347AT4_PSCR_DOWNSHIFT_6X;
1344 phy_data |= I347AT4_PSCR_DOWNSHIFT_ENABLE;
1345
1346 ret_val = phy->ops.write_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
1347 if (ret_val)
1348 return ret_val;
1349
1350 /* Commit the changes. */
1351 ret_val = phy->ops.commit(hw);
1352 if (ret_val) {
1353 DEBUGOUT("Error committing the PHY changes\n");
1354 return ret_val;
1355 }
1356
1357 ret_val = e1000_set_master_slave_mode(hw);
1358 if (ret_val)
1359 return ret_val;
1360
1361 return E1000_SUCCESS;
1362 }
1363
1364 /**
1365 * e1000_copper_link_setup_igp - Setup igp PHY's for copper link
1366 * @hw: pointer to the HW structure
1367 *
1368 * Sets up LPLU, MDI/MDI-X, polarity, Smartspeed and Master/Slave config for
1369 * igp PHY's.
1370 **/
1371 s32 e1000_copper_link_setup_igp(struct e1000_hw *hw)
1372 {
1373 struct e1000_phy_info *phy = &hw->phy;
1374 s32 ret_val;
1375 u16 data;
1376
1377 DEBUGFUNC("e1000_copper_link_setup_igp");
1378
1379
1380 ret_val = hw->phy.ops.reset(hw);
1381 if (ret_val) {
1382 DEBUGOUT("Error resetting the PHY.\n");
1383 return ret_val;
1384 }
1385
1386 /* Wait 100ms for MAC to configure PHY from NVM settings, to avoid
1387 * timeout issues when LFS is enabled.
1388 */
1389 msec_delay(100);
1390
1391 /* The NVM settings will configure LPLU in D3 for
1392 * non-IGP1 PHYs.
1393 */
1394 if (phy->type == e1000_phy_igp) {
1395 /* disable lplu d3 during driver init */
1396 ret_val = hw->phy.ops.set_d3_lplu_state(hw, false);
1397 if (ret_val) {
1398 DEBUGOUT("Error Disabling LPLU D3\n");
1399 return ret_val;
1400 }
1401 }
1402
1403 /* disable lplu d0 during driver init */
1404 if (hw->phy.ops.set_d0_lplu_state) {
1405 ret_val = hw->phy.ops.set_d0_lplu_state(hw, false);
1406 if (ret_val) {
1407 DEBUGOUT("Error Disabling LPLU D0\n");
1408 return ret_val;
1409 }
1410 }
1411 /* Configure mdi-mdix settings */
1412 ret_val = phy->ops.read_reg(hw, IGP01E1000_PHY_PORT_CTRL, &data);
1413 if (ret_val)
1414 return ret_val;
1415
1416 data &= ~IGP01E1000_PSCR_AUTO_MDIX;
1417
1418 switch (phy->mdix) {
1419 case 1:
1420 data &= ~IGP01E1000_PSCR_FORCE_MDI_MDIX;
1421 break;
1422 case 2:
1423 data |= IGP01E1000_PSCR_FORCE_MDI_MDIX;
1424 break;
1425 case 0:
1426 /* FALLTHROUGH */
1427 default:
1428 data |= IGP01E1000_PSCR_AUTO_MDIX;
1429 break;
1430 }
1431 ret_val = phy->ops.write_reg(hw, IGP01E1000_PHY_PORT_CTRL, data);
1432 if (ret_val)
1433 return ret_val;
1434
1435 /* set auto-master slave resolution settings */
1436 if (hw->mac.autoneg) {
1437 /* when autonegotiation advertisement is only 1000Mbps then we
1438 * should disable SmartSpeed and enable Auto MasterSlave
1439 * resolution as hardware default.
1440 */
1441 if (phy->autoneg_advertised == ADVERTISE_1000_FULL) {
1442 /* Disable SmartSpeed */
1443 ret_val = phy->ops.read_reg(hw,
1444 IGP01E1000_PHY_PORT_CONFIG,
1445 &data);
1446 if (ret_val)
1447 return ret_val;
1448
1449 data &= ~IGP01E1000_PSCFR_SMART_SPEED;
1450 ret_val = phy->ops.write_reg(hw,
1451 IGP01E1000_PHY_PORT_CONFIG,
1452 data);
1453 if (ret_val)
1454 return ret_val;
1455
1456 /* Set auto Master/Slave resolution process */
1457 ret_val = phy->ops.read_reg(hw, PHY_1000T_CTRL, &data);
1458 if (ret_val)
1459 return ret_val;
1460
1461 data &= ~CR_1000T_MS_ENABLE;
1462 ret_val = phy->ops.write_reg(hw, PHY_1000T_CTRL, data);
1463 if (ret_val)
1464 return ret_val;
1465 }
1466
1467 ret_val = e1000_set_master_slave_mode(hw);
1468 }
1469
1470 return ret_val;
1471 }
1472
1473 /**
1474 * e1000_phy_setup_autoneg - Configure PHY for auto-negotiation
1475 * @hw: pointer to the HW structure
1476 *
1477 * Reads the MII auto-neg advertisement register and/or the 1000T control
1478 * register and if the PHY is already setup for auto-negotiation, then
1479 * return successful. Otherwise, setup advertisement and flow control to
1480 * the appropriate values for the wanted auto-negotiation.
1481 **/
1482 s32 e1000_phy_setup_autoneg(struct e1000_hw *hw)
1483 {
1484 struct e1000_phy_info *phy = &hw->phy;
1485 s32 ret_val;
1486 u16 mii_autoneg_adv_reg;
1487 u16 mii_1000t_ctrl_reg = 0;
1488
1489 DEBUGFUNC("e1000_phy_setup_autoneg");
1490
1491 phy->autoneg_advertised &= phy->autoneg_mask;
1492
1493 /* Read the MII Auto-Neg Advertisement Register (Address 4). */
1494 ret_val = phy->ops.read_reg(hw, PHY_AUTONEG_ADV, &mii_autoneg_adv_reg);
1495 if (ret_val)
1496 return ret_val;
1497
1498 if (phy->autoneg_mask & ADVERTISE_1000_FULL) {
1499 /* Read the MII 1000Base-T Control Register (Address 9). */
1500 ret_val = phy->ops.read_reg(hw, PHY_1000T_CTRL,
1501 &mii_1000t_ctrl_reg);
1502 if (ret_val)
1503 return ret_val;
1504 }
1505
1506 /* Need to parse both autoneg_advertised and fc and set up
1507 * the appropriate PHY registers. First we will parse for
1508 * autoneg_advertised software override. Since we can advertise
1509 * a plethora of combinations, we need to check each bit
1510 * individually.
1511 */
1512
1513 /* First we clear all the 10/100 mb speed bits in the Auto-Neg
1514 * Advertisement Register (Address 4) and the 1000 mb speed bits in
1515 * the 1000Base-T Control Register (Address 9).
1516 */
1517 mii_autoneg_adv_reg &= ~(NWAY_AR_100TX_FD_CAPS |
1518 NWAY_AR_100TX_HD_CAPS |
1519 NWAY_AR_10T_FD_CAPS |
1520 NWAY_AR_10T_HD_CAPS);
1521 mii_1000t_ctrl_reg &= ~(CR_1000T_HD_CAPS | CR_1000T_FD_CAPS);
1522
1523 DEBUGOUT1("autoneg_advertised %x\n", phy->autoneg_advertised);
1524
1525 /* Do we want to advertise 10 Mb Half Duplex? */
1526 if (phy->autoneg_advertised & ADVERTISE_10_HALF) {
1527 DEBUGOUT("Advertise 10mb Half duplex\n");
1528 mii_autoneg_adv_reg |= NWAY_AR_10T_HD_CAPS;
1529 }
1530
1531 /* Do we want to advertise 10 Mb Full Duplex? */
1532 if (phy->autoneg_advertised & ADVERTISE_10_FULL) {
1533 DEBUGOUT("Advertise 10mb Full duplex\n");
1534 mii_autoneg_adv_reg |= NWAY_AR_10T_FD_CAPS;
1535 }
1536
1537 /* Do we want to advertise 100 Mb Half Duplex? */
1538 if (phy->autoneg_advertised & ADVERTISE_100_HALF) {
1539 DEBUGOUT("Advertise 100mb Half duplex\n");
1540 mii_autoneg_adv_reg |= NWAY_AR_100TX_HD_CAPS;
1541 }
1542
1543 /* Do we want to advertise 100 Mb Full Duplex? */
1544 if (phy->autoneg_advertised & ADVERTISE_100_FULL) {
1545 DEBUGOUT("Advertise 100mb Full duplex\n");
1546 mii_autoneg_adv_reg |= NWAY_AR_100TX_FD_CAPS;
1547 }
1548
1549 /* We do not allow the Phy to advertise 1000 Mb Half Duplex */
1550 if (phy->autoneg_advertised & ADVERTISE_1000_HALF)
1551 DEBUGOUT("Advertise 1000mb Half duplex request denied!\n");
1552
1553 /* Do we want to advertise 1000 Mb Full Duplex? */
1554 if (phy->autoneg_advertised & ADVERTISE_1000_FULL) {
1555 DEBUGOUT("Advertise 1000mb Full duplex\n");
1556 mii_1000t_ctrl_reg |= CR_1000T_FD_CAPS;
1557 }
1558
1559 /* Check for a software override of the flow control settings, and
1560 * setup the PHY advertisement registers accordingly. If
1561 * auto-negotiation is enabled, then software will have to set the
1562 * "PAUSE" bits to the correct value in the Auto-Negotiation
1563 * Advertisement Register (PHY_AUTONEG_ADV) and re-start auto-
1564 * negotiation.
1565 *
1566 * The possible values of the "fc" parameter are:
1567 * 0: Flow control is completely disabled
1568 * 1: Rx flow control is enabled (we can receive pause frames
1569 * but not send pause frames).
1570 * 2: Tx flow control is enabled (we can send pause frames
1571 * but we do not support receiving pause frames).
1572 * 3: Both Rx and Tx flow control (symmetric) are enabled.
1573 * other: No software override. The flow control configuration
1574 * in the EEPROM is used.
1575 */
1576 switch (hw->fc.current_mode) {
1577 case e1000_fc_none:
1578 /* Flow control (Rx & Tx) is completely disabled by a
1579 * software over-ride.
1580 */
1581 mii_autoneg_adv_reg &= ~(NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
1582 break;
1583 case e1000_fc_rx_pause:
1584 /* Rx Flow control is enabled, and Tx Flow control is
1585 * disabled, by a software over-ride.
1586 *
1587 * Since there really isn't a way to advertise that we are
1588 * capable of Rx Pause ONLY, we will advertise that we
1589 * support both symmetric and asymmetric Rx PAUSE. Later
1590 * (in e1000_config_fc_after_link_up) we will disable the
1591 * hw's ability to send PAUSE frames.
1592 */
1593 mii_autoneg_adv_reg |= (NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
1594 break;
1595 case e1000_fc_tx_pause:
1596 /* Tx Flow control is enabled, and Rx Flow control is
1597 * disabled, by a software over-ride.
1598 */
1599 mii_autoneg_adv_reg |= NWAY_AR_ASM_DIR;
1600 mii_autoneg_adv_reg &= ~NWAY_AR_PAUSE;
1601 break;
1602 case e1000_fc_full:
1603 /* Flow control (both Rx and Tx) is enabled by a software
1604 * over-ride.
1605 */
1606 mii_autoneg_adv_reg |= (NWAY_AR_ASM_DIR | NWAY_AR_PAUSE);
1607 break;
1608 default:
1609 DEBUGOUT("Flow control param set incorrectly\n");
1610 return -E1000_ERR_CONFIG;
1611 }
1612
1613 ret_val = phy->ops.write_reg(hw, PHY_AUTONEG_ADV, mii_autoneg_adv_reg);
1614 if (ret_val)
1615 return ret_val;
1616
1617 DEBUGOUT1("Auto-Neg Advertising %x\n", mii_autoneg_adv_reg);
1618
1619 if (phy->autoneg_mask & ADVERTISE_1000_FULL)
1620 ret_val = phy->ops.write_reg(hw, PHY_1000T_CTRL,
1621 mii_1000t_ctrl_reg);
1622
1623 return ret_val;
1624 }
1625
1626 /**
1627 * e1000_copper_link_autoneg - Setup/Enable autoneg for copper link
1628 * @hw: pointer to the HW structure
1629 *
1630 * Performs initial bounds checking on autoneg advertisement parameter, then
1631 * configure to advertise the full capability. Setup the PHY to autoneg
1632 * and restart the negotiation process between the link partner. If
1633 * autoneg_wait_to_complete, then wait for autoneg to complete before exiting.
1634 **/
1635 s32 e1000_copper_link_autoneg(struct e1000_hw *hw)
1636 {
1637 struct e1000_phy_info *phy = &hw->phy;
1638 s32 ret_val;
1639 u16 phy_ctrl;
1640
1641 DEBUGFUNC("e1000_copper_link_autoneg");
1642
1643 /* Perform some bounds checking on the autoneg advertisement
1644 * parameter.
1645 */
1646 phy->autoneg_advertised &= phy->autoneg_mask;
1647
1648 /* If autoneg_advertised is zero, we assume it was not defaulted
1649 * by the calling code so we set to advertise full capability.
1650 */
1651 if (!phy->autoneg_advertised)
1652 phy->autoneg_advertised = phy->autoneg_mask;
1653
1654 DEBUGOUT("Reconfiguring auto-neg advertisement params\n");
1655 ret_val = e1000_phy_setup_autoneg(hw);
1656 if (ret_val) {
1657 DEBUGOUT("Error Setting up Auto-Negotiation\n");
1658 return ret_val;
1659 }
1660 DEBUGOUT("Restarting Auto-Neg\n");
1661
1662 /* Restart auto-negotiation by setting the Auto Neg Enable bit and
1663 * the Auto Neg Restart bit in the PHY control register.
1664 */
1665 ret_val = phy->ops.read_reg(hw, PHY_CONTROL, &phy_ctrl);
1666 if (ret_val)
1667 return ret_val;
1668
1669 phy_ctrl |= (MII_CR_AUTO_NEG_EN | MII_CR_RESTART_AUTO_NEG);
1670 ret_val = phy->ops.write_reg(hw, PHY_CONTROL, phy_ctrl);
1671 if (ret_val)
1672 return ret_val;
1673
1674 /* Does the user want to wait for Auto-Neg to complete here, or
1675 * check at a later time (for example, callback routine).
1676 */
1677 if (phy->autoneg_wait_to_complete) {
1678 ret_val = e1000_wait_autoneg(hw);
1679 if (ret_val) {
1680 DEBUGOUT("Error while waiting for autoneg to complete\n");
1681 return ret_val;
1682 }
1683 }
1684
1685 hw->mac.get_link_status = true;
1686
1687 return ret_val;
1688 }
1689
1690 /**
1691 * e1000_setup_copper_link_generic - Configure copper link settings
1692 * @hw: pointer to the HW structure
1693 *
1694 * Calls the appropriate function to configure the link for auto-neg or forced
1695 * speed and duplex. Then we check for link, once link is established calls
1696 * to configure collision distance and flow control are called. If link is
1697 * not established, we return -E1000_ERR_PHY (-2).
1698 **/
1699 s32 e1000_setup_copper_link_generic(struct e1000_hw *hw)
1700 {
1701 s32 ret_val;
1702 bool link = true;
1703
1704 DEBUGFUNC("e1000_setup_copper_link_generic");
1705
1706 if (hw->mac.autoneg) {
1707 /* Setup autoneg and flow control advertisement and perform
1708 * autonegotiation.
1709 */
1710 ret_val = e1000_copper_link_autoneg(hw);
1711 if (ret_val)
1712 return ret_val;
1713 } else {
1714 /* PHY will be set to 10H, 10F, 100H or 100F
1715 * depending on user settings.
1716 */
1717 DEBUGOUT("Forcing Speed and Duplex\n");
1718 ret_val = hw->phy.ops.force_speed_duplex(hw);
1719 if (ret_val) {
1720 DEBUGOUT("Error Forcing Speed and Duplex\n");
1721 return ret_val;
1722 }
1723 }
1724
1725 /* Check link status. Wait up to 100 microseconds for link to become
1726 * valid.
1727 */
1728 ret_val = e1000_phy_has_link_generic(hw, COPPER_LINK_UP_LIMIT, 10,
1729 &link);
1730 if (ret_val)
1731 return ret_val;
1732
1733 if (link) {
1734 DEBUGOUT("Valid link established!!!\n");
1735 hw->mac.ops.config_collision_dist(hw);
1736 ret_val = e1000_config_fc_after_link_up_generic(hw);
1737 } else {
1738 DEBUGOUT("Unable to establish link!!!\n");
1739 }
1740
1741 return ret_val;
1742 }
1743
1744 /**
1745 * e1000_phy_force_speed_duplex_igp - Force speed/duplex for igp PHY
1746 * @hw: pointer to the HW structure
1747 *
1748 * Calls the PHY setup function to force speed and duplex. Clears the
1749 * auto-crossover to force MDI manually. Waits for link and returns
1750 * successful if link up is successful, else -E1000_ERR_PHY (-2).
1751 **/
1752 s32 e1000_phy_force_speed_duplex_igp(struct e1000_hw *hw)
1753 {
1754 struct e1000_phy_info *phy = &hw->phy;
1755 s32 ret_val;
1756 u16 phy_data;
1757 bool link;
1758
1759 DEBUGFUNC("e1000_phy_force_speed_duplex_igp");
1760
1761 ret_val = phy->ops.read_reg(hw, PHY_CONTROL, &phy_data);
1762 if (ret_val)
1763 return ret_val;
1764
1765 e1000_phy_force_speed_duplex_setup(hw, &phy_data);
1766
1767 ret_val = phy->ops.write_reg(hw, PHY_CONTROL, phy_data);
1768 if (ret_val)
1769 return ret_val;
1770
1771 /* Clear Auto-Crossover to force MDI manually. IGP requires MDI
1772 * forced whenever speed and duplex are forced.
1773 */
1774 ret_val = phy->ops.read_reg(hw, IGP01E1000_PHY_PORT_CTRL, &phy_data);
1775 if (ret_val)
1776 return ret_val;
1777
1778 phy_data &= ~IGP01E1000_PSCR_AUTO_MDIX;
1779 phy_data &= ~IGP01E1000_PSCR_FORCE_MDI_MDIX;
1780
1781 ret_val = phy->ops.write_reg(hw, IGP01E1000_PHY_PORT_CTRL, phy_data);
1782 if (ret_val)
1783 return ret_val;
1784
1785 DEBUGOUT1("IGP PSCR: %X\n", phy_data);
1786
1787 usec_delay(1);
1788
1789 if (phy->autoneg_wait_to_complete) {
1790 DEBUGOUT("Waiting for forced speed/duplex link on IGP phy.\n");
1791
1792 ret_val = e1000_phy_has_link_generic(hw, PHY_FORCE_LIMIT,
1793 100000, &link);
1794 if (ret_val)
1795 return ret_val;
1796
1797 if (!link)
1798 DEBUGOUT("Link taking longer than expected.\n");
1799
1800 /* Try once more */
1801 ret_val = e1000_phy_has_link_generic(hw, PHY_FORCE_LIMIT,
1802 100000, &link);
1803 }
1804
1805 return ret_val;
1806 }
1807
1808 /**
1809 * e1000_phy_force_speed_duplex_m88 - Force speed/duplex for m88 PHY
1810 * @hw: pointer to the HW structure
1811 *
1812 * Calls the PHY setup function to force speed and duplex. Clears the
1813 * auto-crossover to force MDI manually. Resets the PHY to commit the
1814 * changes. If time expires while waiting for link up, we reset the DSP.
1815 * After reset, TX_CLK and CRS on Tx must be set. Return successful upon
1816 * successful completion, else return corresponding error code.
1817 **/
1818 s32 e1000_phy_force_speed_duplex_m88(struct e1000_hw *hw)
1819 {
1820 struct e1000_phy_info *phy = &hw->phy;
1821 s32 ret_val;
1822 u16 phy_data;
1823 bool link;
1824
1825 DEBUGFUNC("e1000_phy_force_speed_duplex_m88");
1826
1827 /* I210 and I211 devices support Auto-Crossover in forced operation. */
1828 if (phy->type != e1000_phy_i210) {
1829 /* Clear Auto-Crossover to force MDI manually. M88E1000
1830 * requires MDI forced whenever speed and duplex are forced.
1831 */
1832 ret_val = phy->ops.read_reg(hw, M88E1000_PHY_SPEC_CTRL,
1833 &phy_data);
1834 if (ret_val)
1835 return ret_val;
1836
1837 phy_data &= ~M88E1000_PSCR_AUTO_X_MODE;
1838 ret_val = phy->ops.write_reg(hw, M88E1000_PHY_SPEC_CTRL,
1839 phy_data);
1840 if (ret_val)
1841 return ret_val;
1842
1843 DEBUGOUT1("M88E1000 PSCR: %X\n", phy_data);
1844 }
1845
1846 ret_val = phy->ops.read_reg(hw, PHY_CONTROL, &phy_data);
1847 if (ret_val)
1848 return ret_val;
1849
1850 e1000_phy_force_speed_duplex_setup(hw, &phy_data);
1851
1852 ret_val = phy->ops.write_reg(hw, PHY_CONTROL, phy_data);
1853 if (ret_val)
1854 return ret_val;
1855
1856 /* Reset the phy to commit changes. */
1857 ret_val = hw->phy.ops.commit(hw);
1858 if (ret_val)
1859 return ret_val;
1860
1861 if (phy->autoneg_wait_to_complete) {
1862 DEBUGOUT("Waiting for forced speed/duplex link on M88 phy.\n");
1863
1864 ret_val = e1000_phy_has_link_generic(hw, PHY_FORCE_LIMIT,
1865 100000, &link);
1866 if (ret_val)
1867 return ret_val;
1868
1869 if (!link) {
1870 bool reset_dsp = true;
1871
1872 switch (hw->phy.id) {
1873 case I347AT4_E_PHY_ID:
1874 case M88E1340M_E_PHY_ID:
1875 case M88E1112_E_PHY_ID:
1876 case M88E1543_E_PHY_ID:
1877 case M88E1512_E_PHY_ID:
1878 case I210_I_PHY_ID:
1879 reset_dsp = false;
1880 break;
1881 default:
1882 if (hw->phy.type != e1000_phy_m88)
1883 reset_dsp = false;
1884 break;
1885 }
1886
1887 if (!reset_dsp) {
1888 DEBUGOUT("Link taking longer than expected.\n");
1889 } else {
1890 /* We didn't get link.
1891 * Reset the DSP and cross our fingers.
1892 */
1893 ret_val = phy->ops.write_reg(hw,
1894 M88E1000_PHY_PAGE_SELECT,
1895 0x001d);
1896 if (ret_val)
1897 return ret_val;
1898 ret_val = e1000_phy_reset_dsp_generic(hw);
1899 if (ret_val)
1900 return ret_val;
1901 }
1902 }
1903
1904 /* Try once more */
1905 ret_val = e1000_phy_has_link_generic(hw, PHY_FORCE_LIMIT,
1906 100000, &link);
1907 if (ret_val)
1908 return ret_val;
1909 }
1910
1911 if (hw->phy.type != e1000_phy_m88)
1912 return E1000_SUCCESS;
1913
1914 if (hw->phy.id == I347AT4_E_PHY_ID ||
1915 hw->phy.id == M88E1340M_E_PHY_ID ||
1916 hw->phy.id == M88E1112_E_PHY_ID)
1917 return E1000_SUCCESS;
1918 if (hw->phy.id == I210_I_PHY_ID)
1919 return E1000_SUCCESS;
1920 if ((hw->phy.id == M88E1543_E_PHY_ID) ||
1921 (hw->phy.id == M88E1512_E_PHY_ID))
1922 return E1000_SUCCESS;
1923 ret_val = phy->ops.read_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL, &phy_data);
1924 if (ret_val)
1925 return ret_val;
1926
1927 /* Resetting the phy means we need to re-force TX_CLK in the
1928 * Extended PHY Specific Control Register to 25MHz clock from
1929 * the reset value of 2.5MHz.
1930 */
1931 phy_data |= M88E1000_EPSCR_TX_CLK_25;
1932 ret_val = phy->ops.write_reg(hw, M88E1000_EXT_PHY_SPEC_CTRL, phy_data);
1933 if (ret_val)
1934 return ret_val;
1935
1936 /* In addition, we must re-enable CRS on Tx for both half and full
1937 * duplex.
1938 */
1939 ret_val = phy->ops.read_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
1940 if (ret_val)
1941 return ret_val;
1942
1943 phy_data |= M88E1000_PSCR_ASSERT_CRS_ON_TX;
1944 ret_val = phy->ops.write_reg(hw, M88E1000_PHY_SPEC_CTRL, phy_data);
1945
1946 return ret_val;
1947 }
1948
1949 /**
1950 * e1000_phy_force_speed_duplex_ife - Force PHY speed & duplex
1951 * @hw: pointer to the HW structure
1952 *
1953 * Forces the speed and duplex settings of the PHY.
1954 * This is a function pointer entry point only called by
1955 * PHY setup routines.
1956 **/
1957 s32 e1000_phy_force_speed_duplex_ife(struct e1000_hw *hw)
1958 {
1959 struct e1000_phy_info *phy = &hw->phy;
1960 s32 ret_val;
1961 u16 data;
1962 bool link;
1963
1964 DEBUGFUNC("e1000_phy_force_speed_duplex_ife");
1965
1966 ret_val = phy->ops.read_reg(hw, PHY_CONTROL, &data);
1967 if (ret_val)
1968 return ret_val;
1969
1970 e1000_phy_force_speed_duplex_setup(hw, &data);
1971
1972 ret_val = phy->ops.write_reg(hw, PHY_CONTROL, data);
1973 if (ret_val)
1974 return ret_val;
1975
1976 /* Disable MDI-X support for 10/100 */
1977 ret_val = phy->ops.read_reg(hw, IFE_PHY_MDIX_CONTROL, &data);
1978 if (ret_val)
1979 return ret_val;
1980
1981 data &= ~IFE_PMC_AUTO_MDIX;
1982 data &= ~IFE_PMC_FORCE_MDIX;
1983
1984 ret_val = phy->ops.write_reg(hw, IFE_PHY_MDIX_CONTROL, data);
1985 if (ret_val)
1986 return ret_val;
1987
1988 DEBUGOUT1("IFE PMC: %X\n", data);
1989
1990 usec_delay(1);
1991
1992 if (phy->autoneg_wait_to_complete) {
1993 DEBUGOUT("Waiting for forced speed/duplex link on IFE phy.\n");
1994
1995 ret_val = e1000_phy_has_link_generic(hw, PHY_FORCE_LIMIT,
1996 100000, &link);
1997 if (ret_val)
1998 return ret_val;
1999
2000 if (!link)
2001 DEBUGOUT("Link taking longer than expected.\n");
2002
2003 /* Try once more */
2004 ret_val = e1000_phy_has_link_generic(hw, PHY_FORCE_LIMIT,
2005 100000, &link);
2006 if (ret_val)
2007 return ret_val;
2008 }
2009
2010 return E1000_SUCCESS;
2011 }
2012
2013 /**
2014 * e1000_phy_force_speed_duplex_setup - Configure forced PHY speed/duplex
2015 * @hw: pointer to the HW structure
2016 * @phy_ctrl: pointer to current value of PHY_CONTROL
2017 *
2018 * Forces speed and duplex on the PHY by doing the following: disable flow
2019 * control, force speed/duplex on the MAC, disable auto speed detection,
2020 * disable auto-negotiation, configure duplex, configure speed, configure
2021 * the collision distance, write configuration to CTRL register. The
2022 * caller must write to the PHY_CONTROL register for these settings to
2023 * take effect.
2024 **/
2025 void e1000_phy_force_speed_duplex_setup(struct e1000_hw *hw, u16 *phy_ctrl)
2026 {
2027 struct e1000_mac_info *mac = &hw->mac;
2028 u32 ctrl;
2029
2030 DEBUGFUNC("e1000_phy_force_speed_duplex_setup");
2031
2032 /* Turn off flow control when forcing speed/duplex */
2033 hw->fc.current_mode = e1000_fc_none;
2034
2035 /* Force speed/duplex on the mac */
2036 ctrl = E1000_READ_REG(hw, E1000_CTRL);
2037 ctrl |= (E1000_CTRL_FRCSPD | E1000_CTRL_FRCDPX);
2038 ctrl &= ~E1000_CTRL_SPD_SEL;
2039
2040 /* Disable Auto Speed Detection */
2041 ctrl &= ~E1000_CTRL_ASDE;
2042
2043 /* Disable autoneg on the phy */
2044 *phy_ctrl &= ~MII_CR_AUTO_NEG_EN;
2045
2046 /* Forcing Full or Half Duplex? */
2047 if (mac->forced_speed_duplex & E1000_ALL_HALF_DUPLEX) {
2048 ctrl &= ~E1000_CTRL_FD;
2049 *phy_ctrl &= ~MII_CR_FULL_DUPLEX;
2050 DEBUGOUT("Half Duplex\n");
2051 } else {
2052 ctrl |= E1000_CTRL_FD;
2053 *phy_ctrl |= MII_CR_FULL_DUPLEX;
2054 DEBUGOUT("Full Duplex\n");
2055 }
2056
2057 /* Forcing 10mb or 100mb? */
2058 if (mac->forced_speed_duplex & E1000_ALL_100_SPEED) {
2059 ctrl |= E1000_CTRL_SPD_100;
2060 *phy_ctrl |= MII_CR_SPEED_100;
2061 *phy_ctrl &= ~MII_CR_SPEED_1000;
2062 DEBUGOUT("Forcing 100mb\n");
2063 } else {
2064 ctrl &= ~(E1000_CTRL_SPD_1000 | E1000_CTRL_SPD_100);
2065 *phy_ctrl &= ~(MII_CR_SPEED_1000 | MII_CR_SPEED_100);
2066 DEBUGOUT("Forcing 10mb\n");
2067 }
2068
2069 hw->mac.ops.config_collision_dist(hw);
2070
2071 E1000_WRITE_REG(hw, E1000_CTRL, ctrl);
2072 }
2073
2074 /**
2075 * e1000_set_d3_lplu_state_generic - Sets low power link up state for D3
2076 * @hw: pointer to the HW structure
2077 * @active: boolean used to enable/disable lplu
2078 *
2079 * Success returns 0, Failure returns 1
2080 *
2081 * The low power link up (lplu) state is set to the power management level D3
2082 * and SmartSpeed is disabled when active is true, else clear lplu for D3
2083 * and enable Smartspeed. LPLU and Smartspeed are mutually exclusive. LPLU
2084 * is used during Dx states where the power conservation is most important.
2085 * During driver activity, SmartSpeed should be enabled so performance is
2086 * maintained.
2087 **/
2088 s32 e1000_set_d3_lplu_state_generic(struct e1000_hw *hw, bool active)
2089 {
2090 struct e1000_phy_info *phy = &hw->phy;
2091 s32 ret_val;
2092 u16 data;
2093
2094 DEBUGFUNC("e1000_set_d3_lplu_state_generic");
2095
2096 if (!hw->phy.ops.read_reg)
2097 return E1000_SUCCESS;
2098
2099 ret_val = phy->ops.read_reg(hw, IGP02E1000_PHY_POWER_MGMT, &data);
2100 if (ret_val)
2101 return ret_val;
2102
2103 if (!active) {
2104 data &= ~IGP02E1000_PM_D3_LPLU;
2105 ret_val = phy->ops.write_reg(hw, IGP02E1000_PHY_POWER_MGMT,
2106 data);
2107 if (ret_val)
2108 return ret_val;
2109 /* LPLU and SmartSpeed are mutually exclusive. LPLU is used
2110 * during Dx states where the power conservation is most
2111 * important. During driver activity we should enable
2112 * SmartSpeed, so performance is maintained.
2113 */
2114 if (phy->smart_speed == e1000_smart_speed_on) {
2115 ret_val = phy->ops.read_reg(hw,
2116 IGP01E1000_PHY_PORT_CONFIG,
2117 &data);
2118 if (ret_val)
2119 return ret_val;
2120
2121 data |= IGP01E1000_PSCFR_SMART_SPEED;
2122 ret_val = phy->ops.write_reg(hw,
2123 IGP01E1000_PHY_PORT_CONFIG,
2124 data);
2125 if (ret_val)
2126 return ret_val;
2127 } else if (phy->smart_speed == e1000_smart_speed_off) {
2128 ret_val = phy->ops.read_reg(hw,
2129 IGP01E1000_PHY_PORT_CONFIG,
2130 &data);
2131 if (ret_val)
2132 return ret_val;
2133
2134 data &= ~IGP01E1000_PSCFR_SMART_SPEED;
2135 ret_val = phy->ops.write_reg(hw,
2136 IGP01E1000_PHY_PORT_CONFIG,
2137 data);
2138 if (ret_val)
2139 return ret_val;
2140 }
2141 } else if ((phy->autoneg_advertised == E1000_ALL_SPEED_DUPLEX) ||
2142 (phy->autoneg_advertised == E1000_ALL_NOT_GIG) ||
2143 (phy->autoneg_advertised == E1000_ALL_10_SPEED)) {
2144 data |= IGP02E1000_PM_D3_LPLU;
2145 ret_val = phy->ops.write_reg(hw, IGP02E1000_PHY_POWER_MGMT,
2146 data);
2147 if (ret_val)
2148 return ret_val;
2149
2150 /* When LPLU is enabled, we should disable SmartSpeed */
2151 ret_val = phy->ops.read_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
2152 &data);
2153 if (ret_val)
2154 return ret_val;
2155
2156 data &= ~IGP01E1000_PSCFR_SMART_SPEED;
2157 ret_val = phy->ops.write_reg(hw, IGP01E1000_PHY_PORT_CONFIG,
2158 data);
2159 }
2160
2161 return ret_val;
2162 }
2163
2164 /**
2165 * e1000_check_downshift_generic - Checks whether a downshift in speed occurred
2166 * @hw: pointer to the HW structure
2167 *
2168 * Success returns 0, Failure returns 1
2169 *
2170 * A downshift is detected by querying the PHY link health.
2171 **/
2172 s32 e1000_check_downshift_generic(struct e1000_hw *hw)
2173 {
2174 struct e1000_phy_info *phy = &hw->phy;
2175 s32 ret_val;
2176 u16 phy_data, offset, mask;
2177
2178 DEBUGFUNC("e1000_check_downshift_generic");
2179
2180 switch (phy->type) {
2181 case e1000_phy_i210:
2182 case e1000_phy_m88:
2183 case e1000_phy_gg82563:
2184 case e1000_phy_bm:
2185 case e1000_phy_82578:
2186 offset = M88E1000_PHY_SPEC_STATUS;
2187 mask = M88E1000_PSSR_DOWNSHIFT;
2188 break;
2189 case e1000_phy_igp:
2190 case e1000_phy_igp_2:
2191 case e1000_phy_igp_3:
2192 offset = IGP01E1000_PHY_LINK_HEALTH;
2193 mask = IGP01E1000_PLHR_SS_DOWNGRADE;
2194 break;
2195 default:
2196 /* speed downshift not supported */
2197 phy->speed_downgraded = false;
2198 return E1000_SUCCESS;
2199 }
2200
2201 ret_val = phy->ops.read_reg(hw, offset, &phy_data);
2202
2203 if (!ret_val)
2204 phy->speed_downgraded = !!(phy_data & mask);
2205
2206 return ret_val;
2207 }
2208
2209 /**
2210 * e1000_check_polarity_m88 - Checks the polarity.
2211 * @hw: pointer to the HW structure
2212 *
2213 * Success returns 0, Failure returns -E1000_ERR_PHY (-2)
2214 *
2215 * Polarity is determined based on the PHY specific status register.
2216 **/
2217 s32 e1000_check_polarity_m88(struct e1000_hw *hw)
2218 {
2219 struct e1000_phy_info *phy = &hw->phy;
2220 s32 ret_val;
2221 u16 data;
2222
2223 DEBUGFUNC("e1000_check_polarity_m88");
2224
2225 ret_val = phy->ops.read_reg(hw, M88E1000_PHY_SPEC_STATUS, &data);
2226
2227 if (!ret_val)
2228 phy->cable_polarity = ((data & M88E1000_PSSR_REV_POLARITY)
2229 ? e1000_rev_polarity_reversed
2230 : e1000_rev_polarity_normal);
2231
2232 return ret_val;
2233 }
2234
2235 /**
2236 * e1000_check_polarity_igp - Checks the polarity.
2237 * @hw: pointer to the HW structure
2238 *
2239 * Success returns 0, Failure returns -E1000_ERR_PHY (-2)
2240 *
2241 * Polarity is determined based on the PHY port status register, and the
2242 * current speed (since there is no polarity at 100Mbps).
2243 **/
2244 s32 e1000_check_polarity_igp(struct e1000_hw *hw)
2245 {
2246 struct e1000_phy_info *phy = &hw->phy;
2247 s32 ret_val;
2248 u16 data, offset, mask;
2249
2250 DEBUGFUNC("e1000_check_polarity_igp");
2251
2252 /* Polarity is determined based on the speed of
2253 * our connection.
2254 */
2255 ret_val = phy->ops.read_reg(hw, IGP01E1000_PHY_PORT_STATUS, &data);
2256 if (ret_val)
2257 return ret_val;
2258
2259 if ((data & IGP01E1000_PSSR_SPEED_MASK) ==
2260 IGP01E1000_PSSR_SPEED_1000MBPS) {
2261 offset = IGP01E1000_PHY_PCS_INIT_REG;
2262 mask = IGP01E1000_PHY_POLARITY_MASK;
2263 } else {
2264 /* This really only applies to 10Mbps since
2265 * there is no polarity for 100Mbps (always 0).
2266 */
2267 offset = IGP01E1000_PHY_PORT_STATUS;
2268 mask = IGP01E1000_PSSR_POLARITY_REVERSED;
2269 }
2270
2271 ret_val = phy->ops.read_reg(hw, offset, &data);
2272
2273 if (!ret_val)
2274 phy->cable_polarity = ((data & mask)
2275 ? e1000_rev_polarity_reversed
2276 : e1000_rev_polarity_normal);
2277
2278 return ret_val;
2279 }
2280
2281 /**
2282 * e1000_check_polarity_ife - Check cable polarity for IFE PHY
2283 * @hw: pointer to the HW structure
2284 *
2285 * Polarity is determined on the polarity reversal feature being enabled.
2286 **/
2287 s32 e1000_check_polarity_ife(struct e1000_hw *hw)
2288 {
2289 struct e1000_phy_info *phy = &hw->phy;
2290 s32 ret_val;
2291 u16 phy_data, offset, mask;
2292
2293 DEBUGFUNC("e1000_check_polarity_ife");
2294
2295 /* Polarity is determined based on the reversal feature being enabled.
2296 */
2297 if (phy->polarity_correction) {
2298 offset = IFE_PHY_EXTENDED_STATUS_CONTROL;
2299 mask = IFE_PESC_POLARITY_REVERSED;
2300 } else {
2301 offset = IFE_PHY_SPECIAL_CONTROL;
2302 mask = IFE_PSC_FORCE_POLARITY;
2303 }
2304
2305 ret_val = phy->ops.read_reg(hw, offset, &phy_data);
2306
2307 if (!ret_val)
2308 phy->cable_polarity = ((phy_data & mask)
2309 ? e1000_rev_polarity_reversed
2310 : e1000_rev_polarity_normal);
2311
2312 return ret_val;
2313 }
2314
2315 /**
2316 * e1000_wait_autoneg - Wait for auto-neg completion
2317 * @hw: pointer to the HW structure
2318 *
2319 * Waits for auto-negotiation to complete or for the auto-negotiation time
2320 * limit to expire, which ever happens first.
2321 **/
2322 static s32 e1000_wait_autoneg(struct e1000_hw *hw)
2323 {
2324 s32 ret_val = E1000_SUCCESS;
2325 u16 i, phy_status;
2326
2327 DEBUGFUNC("e1000_wait_autoneg");
2328
2329 if (!hw->phy.ops.read_reg)
2330 return E1000_SUCCESS;
2331
2332 /* Break after autoneg completes or PHY_AUTO_NEG_LIMIT expires. */
2333 for (i = PHY_AUTO_NEG_LIMIT; i > 0; i--) {
2334 ret_val = hw->phy.ops.read_reg(hw, PHY_STATUS, &phy_status);
2335 if (ret_val)
2336 break;
2337 ret_val = hw->phy.ops.read_reg(hw, PHY_STATUS, &phy_status);
2338 if (ret_val)
2339 break;
2340 if (phy_status & MII_SR_AUTONEG_COMPLETE)
2341 break;
2342 msec_delay(100);
2343 }
2344
2345 /* PHY_AUTO_NEG_TIME expiration doesn't guarantee auto-negotiation
2346 * has completed.
2347 */
2348 return ret_val;
2349 }
2350
2351 /**
2352 * e1000_phy_has_link_generic - Polls PHY for link
2353 * @hw: pointer to the HW structure
2354 * @iterations: number of times to poll for link
2355 * @usec_interval: delay between polling attempts
2356 * @success: pointer to whether polling was successful or not
2357 *
2358 * Polls the PHY status register for link, 'iterations' number of times.
2359 **/
2360 s32 e1000_phy_has_link_generic(struct e1000_hw *hw, u32 iterations,
2361 u32 usec_interval, bool *success)
2362 {
2363 s32 ret_val = E1000_SUCCESS;
2364 u16 i, phy_status;
2365
2366 DEBUGFUNC("e1000_phy_has_link_generic");
2367
2368 if (!hw->phy.ops.read_reg)
2369 return E1000_SUCCESS;
2370
2371 for (i = 0; i < iterations; i++) {
2372 /* Some PHYs require the PHY_STATUS register to be read
2373 * twice due to the link bit being sticky. No harm doing
2374 * it across the board.
2375 */
2376 ret_val = hw->phy.ops.read_reg(hw, PHY_STATUS, &phy_status);
2377 if (ret_val) {
2378 /* If the first read fails, another entity may have
2379 * ownership of the resources, wait and try again to
2380 * see if they have relinquished the resources yet.
2381 */
2382 if (usec_interval >= 1000)
2383 msec_delay(usec_interval/1000);
2384 else
2385 usec_delay(usec_interval);
2386 }
2387 ret_val = hw->phy.ops.read_reg(hw, PHY_STATUS, &phy_status);
2388 if (ret_val)
2389 break;
2390 if (phy_status & MII_SR_LINK_STATUS)
2391 break;
2392 if (usec_interval >= 1000)
2393 msec_delay(usec_interval/1000);
2394 else
2395 usec_delay(usec_interval);
2396 }
2397
2398 *success = (i < iterations);
2399
2400 return ret_val;
2401 }
2402
2403 /**
2404 * e1000_get_cable_length_m88 - Determine cable length for m88 PHY
2405 * @hw: pointer to the HW structure
2406 *
2407 * Reads the PHY specific status register to retrieve the cable length
2408 * information. The cable length is determined by averaging the minimum and
2409 * maximum values to get the "average" cable length. The m88 PHY has four
2410 * possible cable length values, which are:
2411 * Register Value Cable Length
2412 * 0 < 50 meters
2413 * 1 50 - 80 meters
2414 * 2 80 - 110 meters
2415 * 3 110 - 140 meters
2416 * 4 > 140 meters
2417 **/
2418 s32 e1000_get_cable_length_m88(struct e1000_hw *hw)
2419 {
2420 struct e1000_phy_info *phy = &hw->phy;
2421 s32 ret_val;
2422 u16 phy_data, index;
2423
2424 DEBUGFUNC("e1000_get_cable_length_m88");
2425
2426 ret_val = phy->ops.read_reg(hw, M88E1000_PHY_SPEC_STATUS, &phy_data);
2427 if (ret_val)
2428 return ret_val;
2429
2430 index = ((phy_data & M88E1000_PSSR_CABLE_LENGTH) >>
2431 M88E1000_PSSR_CABLE_LENGTH_SHIFT);
2432
2433 if (index >= M88E1000_CABLE_LENGTH_TABLE_SIZE - 1)
2434 return -E1000_ERR_PHY;
2435
2436 phy->min_cable_length = e1000_m88_cable_length_table[index];
2437 phy->max_cable_length = e1000_m88_cable_length_table[index + 1];
2438
2439 phy->cable_length = (phy->min_cable_length + phy->max_cable_length) / 2;
2440
2441 return E1000_SUCCESS;
2442 }
2443
2444 s32 e1000_get_cable_length_m88_gen2(struct e1000_hw *hw)
2445 {
2446 struct e1000_phy_info *phy = &hw->phy;
2447 s32 ret_val;
2448 u16 phy_data, phy_data2, is_cm;
2449 u16 index, default_page;
2450
2451 DEBUGFUNC("e1000_get_cable_length_m88_gen2");
2452
2453 switch (hw->phy.id) {
2454 case I210_I_PHY_ID:
2455 /* Get cable length from PHY Cable Diagnostics Control Reg */
2456 ret_val = phy->ops.read_reg(hw, (0x7 << GS40G_PAGE_SHIFT) +
2457 (I347AT4_PCDL + phy->addr),
2458 &phy_data);
2459 if (ret_val)
2460 return ret_val;
2461
2462 /* Check if the unit of cable length is meters or cm */
2463 ret_val = phy->ops.read_reg(hw, (0x7 << GS40G_PAGE_SHIFT) +
2464 I347AT4_PCDC, &phy_data2);
2465 if (ret_val)
2466 return ret_val;
2467
2468 is_cm = !(phy_data2 & I347AT4_PCDC_CABLE_LENGTH_UNIT);
2469
2470 /* Populate the phy structure with cable length in meters */
2471 phy->min_cable_length = phy_data / (is_cm ? 100 : 1);
2472 phy->max_cable_length = phy_data / (is_cm ? 100 : 1);
2473 phy->cable_length = phy_data / (is_cm ? 100 : 1);
2474 break;
2475 case M88E1543_E_PHY_ID:
2476 case M88E1512_E_PHY_ID:
2477 case M88E1340M_E_PHY_ID:
2478 case I347AT4_E_PHY_ID:
2479 /* Remember the original page select and set it to 7 */
2480 ret_val = phy->ops.read_reg(hw, I347AT4_PAGE_SELECT,
2481 &default_page);
2482 if (ret_val)
2483 return ret_val;
2484
2485 ret_val = phy->ops.write_reg(hw, I347AT4_PAGE_SELECT, 0x07);
2486 if (ret_val)
2487 return ret_val;
2488
2489 /* Get cable length from PHY Cable Diagnostics Control Reg */
2490 ret_val = phy->ops.read_reg(hw, (I347AT4_PCDL + phy->addr),
2491 &phy_data);
2492 if (ret_val)
2493 return ret_val;
2494
2495 /* Check if the unit of cable length is meters or cm */
2496 ret_val = phy->ops.read_reg(hw, I347AT4_PCDC, &phy_data2);
2497 if (ret_val)
2498 return ret_val;
2499
2500 is_cm = !(phy_data2 & I347AT4_PCDC_CABLE_LENGTH_UNIT);
2501
2502 /* Populate the phy structure with cable length in meters */
2503 phy->min_cable_length = phy_data / (is_cm ? 100 : 1);
2504 phy->max_cable_length = phy_data / (is_cm ? 100 : 1);
2505 phy->cable_length = phy_data / (is_cm ? 100 : 1);
2506
2507 /* Reset the page select to its original value */
2508 ret_val = phy->ops.write_reg(hw, I347AT4_PAGE_SELECT,
2509 default_page);
2510 if (ret_val)
2511 return ret_val;
2512 break;
2513
2514 case M88E1112_E_PHY_ID:
2515 /* Remember the original page select and set it to 5 */
2516 ret_val = phy->ops.read_reg(hw, I347AT4_PAGE_SELECT,
2517 &default_page);
2518 if (ret_val)
2519 return ret_val;
2520
2521 ret_val = phy->ops.write_reg(hw, I347AT4_PAGE_SELECT, 0x05);
2522 if (ret_val)
2523 return ret_val;
2524
2525 ret_val = phy->ops.read_reg(hw, M88E1112_VCT_DSP_DISTANCE,
2526 &phy_data);
2527 if (ret_val)
2528 return ret_val;
2529
2530 index = (phy_data & M88E1000_PSSR_CABLE_LENGTH) >>
2531 M88E1000_PSSR_CABLE_LENGTH_SHIFT;
2532
2533 if (index >= M88E1000_CABLE_LENGTH_TABLE_SIZE - 1)
2534 return -E1000_ERR_PHY;
2535
2536 phy->min_cable_length = e1000_m88_cable_length_table[index];
2537 phy->max_cable_length = e1000_m88_cable_length_table[index + 1];
2538
2539 phy->cable_length = (phy->min_cable_length +
2540 phy->max_cable_length) / 2;
2541
2542 /* Reset the page select to its original value */
2543 ret_val = phy->ops.write_reg(hw, I347AT4_PAGE_SELECT,
2544 default_page);
2545 if (ret_val)
2546 return ret_val;
2547
2548 break;
2549 default:
2550 return -E1000_ERR_PHY;
2551 }
2552
2553 return ret_val;
2554 }
2555
2556 /**
2557 * e1000_get_cable_length_igp_2 - Determine cable length for igp2 PHY
2558 * @hw: pointer to the HW structure
2559 *
2560 * The automatic gain control (agc) normalizes the amplitude of the
2561 * received signal, adjusting for the attenuation produced by the
2562 * cable. By reading the AGC registers, which represent the
2563 * combination of coarse and fine gain value, the value can be put
2564 * into a lookup table to obtain the approximate cable length
2565 * for each channel.
2566 **/
2567 s32 e1000_get_cable_length_igp_2(struct e1000_hw *hw)
2568 {
2569 struct e1000_phy_info *phy = &hw->phy;
2570 s32 ret_val;
2571 u16 phy_data, i, agc_value = 0;
2572 u16 cur_agc_index, max_agc_index = 0;
2573 u16 min_agc_index = IGP02E1000_CABLE_LENGTH_TABLE_SIZE - 1;
2574 static const u16 agc_reg_array[IGP02E1000_PHY_CHANNEL_NUM] = {
2575 IGP02E1000_PHY_AGC_A,
2576 IGP02E1000_PHY_AGC_B,
2577 IGP02E1000_PHY_AGC_C,
2578 IGP02E1000_PHY_AGC_D
2579 };
2580
2581 DEBUGFUNC("e1000_get_cable_length_igp_2");
2582
2583 /* Read the AGC registers for all channels */
2584 for (i = 0; i < IGP02E1000_PHY_CHANNEL_NUM; i++) {
2585 ret_val = phy->ops.read_reg(hw, agc_reg_array[i], &phy_data);
2586 if (ret_val)
2587 return ret_val;
2588
2589 /* Getting bits 15:9, which represent the combination of
2590 * coarse and fine gain values. The result is a number
2591 * that can be put into the lookup table to obtain the
2592 * approximate cable length.
2593 */
2594 cur_agc_index = ((phy_data >> IGP02E1000_AGC_LENGTH_SHIFT) &
2595 IGP02E1000_AGC_LENGTH_MASK);
2596
2597 /* Array index bound check. */
2598 if ((cur_agc_index >= IGP02E1000_CABLE_LENGTH_TABLE_SIZE) ||
2599 (cur_agc_index == 0))
2600 return -E1000_ERR_PHY;
2601
2602 /* Remove min & max AGC values from calculation. */
2603 if (e1000_igp_2_cable_length_table[min_agc_index] >
2604 e1000_igp_2_cable_length_table[cur_agc_index])
2605 min_agc_index = cur_agc_index;
2606 if (e1000_igp_2_cable_length_table[max_agc_index] <
2607 e1000_igp_2_cable_length_table[cur_agc_index])
2608 max_agc_index = cur_agc_index;
2609
2610 agc_value += e1000_igp_2_cable_length_table[cur_agc_index];
2611 }
2612
2613 agc_value -= (e1000_igp_2_cable_length_table[min_agc_index] +
2614 e1000_igp_2_cable_length_table[max_agc_index]);
2615 agc_value /= (IGP02E1000_PHY_CHANNEL_NUM - 2);
2616
2617 /* Calculate cable length with the error range of +/- 10 meters. */
2618 phy->min_cable_length = (((agc_value - IGP02E1000_AGC_RANGE) > 0) ?
2619 (agc_value - IGP02E1000_AGC_RANGE) : 0);
2620 phy->max_cable_length = agc_value + IGP02E1000_AGC_RANGE;
2621
2622 phy->cable_length = (phy->min_cable_length + phy->max_cable_length) / 2;
2623
2624 return E1000_SUCCESS;
2625 }
2626
2627 /**
2628 * e1000_get_phy_info_m88 - Retrieve PHY information
2629 * @hw: pointer to the HW structure
2630 *
2631 * Valid for only copper links. Read the PHY status register (sticky read)
2632 * to verify that link is up. Read the PHY special control register to
2633 * determine the polarity and 10base-T extended distance. Read the PHY
2634 * special status register to determine MDI/MDIx and current speed. If
2635 * speed is 1000, then determine cable length, local and remote receiver.
2636 **/
2637 s32 e1000_get_phy_info_m88(struct e1000_hw *hw)
2638 {
2639 struct e1000_phy_info *phy = &hw->phy;
2640 s32 ret_val;
2641 u16 phy_data;
2642 bool link;
2643
2644 DEBUGFUNC("e1000_get_phy_info_m88");
2645
2646 if (phy->media_type != e1000_media_type_copper) {
2647 DEBUGOUT("Phy info is only valid for copper media\n");
2648 return -E1000_ERR_CONFIG;
2649 }
2650
2651 ret_val = e1000_phy_has_link_generic(hw, 1, 0, &link);
2652 if (ret_val)
2653 return ret_val;
2654
2655 if (!link) {
2656 DEBUGOUT("Phy info is only valid if link is up\n");
2657 return -E1000_ERR_CONFIG;
2658 }
2659
2660 ret_val = phy->ops.read_reg(hw, M88E1000_PHY_SPEC_CTRL, &phy_data);
2661 if (ret_val)
2662 return ret_val;
2663
2664 phy->polarity_correction = !!(phy_data &
2665 M88E1000_PSCR_POLARITY_REVERSAL);
2666
2667 ret_val = e1000_check_polarity_m88(hw);
2668 if (ret_val)
2669 return ret_val;
2670
2671 ret_val = phy->ops.read_reg(hw, M88E1000_PHY_SPEC_STATUS, &phy_data);
2672 if (ret_val)
2673 return ret_val;
2674
2675 phy->is_mdix = !!(phy_data & M88E1000_PSSR_MDIX);
2676
2677 if ((phy_data & M88E1000_PSSR_SPEED) == M88E1000_PSSR_1000MBS) {
2678 ret_val = hw->phy.ops.get_cable_length(hw);
2679 if (ret_val)
2680 return ret_val;
2681
2682 ret_val = phy->ops.read_reg(hw, PHY_1000T_STATUS, &phy_data);
2683 if (ret_val)
2684 return ret_val;
2685
2686 phy->local_rx = (phy_data & SR_1000T_LOCAL_RX_STATUS)
2687 ? e1000_1000t_rx_status_ok
2688 : e1000_1000t_rx_status_not_ok;
2689
2690 phy->remote_rx = (phy_data & SR_1000T_REMOTE_RX_STATUS)
2691 ? e1000_1000t_rx_status_ok
2692 : e1000_1000t_rx_status_not_ok;
2693 } else {
2694 /* Set values to "undefined" */
2695 phy->cable_length = E1000_CABLE_LENGTH_UNDEFINED;
2696 phy->local_rx = e1000_1000t_rx_status_undefined;
2697 phy->remote_rx = e1000_1000t_rx_status_undefined;
2698 }
2699
2700 return ret_val;
2701 }
2702
2703 /**
2704 * e1000_get_phy_info_igp - Retrieve igp PHY information
2705 * @hw: pointer to the HW structure
2706 *
2707 * Read PHY status to determine if link is up. If link is up, then
2708 * set/determine 10base-T extended distance and polarity correction. Read
2709 * PHY port status to determine MDI/MDIx and speed. Based on the speed,
2710 * determine on the cable length, local and remote receiver.
2711 **/
2712 s32 e1000_get_phy_info_igp(struct e1000_hw *hw)
2713 {
2714 struct e1000_phy_info *phy = &hw->phy;
2715 s32 ret_val;
2716 u16 data;
2717 bool link;
2718
2719 DEBUGFUNC("e1000_get_phy_info_igp");
2720
2721 ret_val = e1000_phy_has_link_generic(hw, 1, 0, &link);
2722 if (ret_val)
2723 return ret_val;
2724
2725 if (!link) {
2726 DEBUGOUT("Phy info is only valid if link is up\n");
2727 return -E1000_ERR_CONFIG;
2728 }
2729
2730 phy->polarity_correction = true;
2731
2732 ret_val = e1000_check_polarity_igp(hw);
2733 if (ret_val)
2734 return ret_val;
2735
2736 ret_val = phy->ops.read_reg(hw, IGP01E1000_PHY_PORT_STATUS, &data);
2737 if (ret_val)
2738 return ret_val;
2739
2740 phy->is_mdix = !!(data & IGP01E1000_PSSR_MDIX);
2741
2742 if ((data & IGP01E1000_PSSR_SPEED_MASK) ==
2743 IGP01E1000_PSSR_SPEED_1000MBPS) {
2744 ret_val = phy->ops.get_cable_length(hw);
2745 if (ret_val)
2746 return ret_val;
2747
2748 ret_val = phy->ops.read_reg(hw, PHY_1000T_STATUS, &data);
2749 if (ret_val)
2750 return ret_val;
2751
2752 phy->local_rx = (data & SR_1000T_LOCAL_RX_STATUS)
2753 ? e1000_1000t_rx_status_ok
2754 : e1000_1000t_rx_status_not_ok;
2755
2756 phy->remote_rx = (data & SR_1000T_REMOTE_RX_STATUS)
2757 ? e1000_1000t_rx_status_ok
2758 : e1000_1000t_rx_status_not_ok;
2759 } else {
2760 phy->cable_length = E1000_CABLE_LENGTH_UNDEFINED;
2761 phy->local_rx = e1000_1000t_rx_status_undefined;
2762 phy->remote_rx = e1000_1000t_rx_status_undefined;
2763 }
2764
2765 return ret_val;
2766 }
2767
2768 /**
2769 * e1000_get_phy_info_ife - Retrieves various IFE PHY states
2770 * @hw: pointer to the HW structure
2771 *
2772 * Populates "phy" structure with various feature states.
2773 **/
2774 s32 e1000_get_phy_info_ife(struct e1000_hw *hw)
2775 {
2776 struct e1000_phy_info *phy = &hw->phy;
2777 s32 ret_val;
2778 u16 data;
2779 bool link;
2780
2781 DEBUGFUNC("e1000_get_phy_info_ife");
2782
2783 ret_val = e1000_phy_has_link_generic(hw, 1, 0, &link);
2784 if (ret_val)
2785 return ret_val;
2786
2787 if (!link) {
2788 DEBUGOUT("Phy info is only valid if link is up\n");
2789 return -E1000_ERR_CONFIG;
2790 }
2791
2792 ret_val = phy->ops.read_reg(hw, IFE_PHY_SPECIAL_CONTROL, &data);
2793 if (ret_val)
2794 return ret_val;
2795 phy->polarity_correction = !(data & IFE_PSC_AUTO_POLARITY_DISABLE);
2796
2797 if (phy->polarity_correction) {
2798 ret_val = e1000_check_polarity_ife(hw);
2799 if (ret_val)
2800 return ret_val;
2801 } else {
2802 /* Polarity is forced */
2803 phy->cable_polarity = ((data & IFE_PSC_FORCE_POLARITY)
2804 ? e1000_rev_polarity_reversed
2805 : e1000_rev_polarity_normal);
2806 }
2807
2808 ret_val = phy->ops.read_reg(hw, IFE_PHY_MDIX_CONTROL, &data);
2809 if (ret_val)
2810 return ret_val;
2811
2812 phy->is_mdix = !!(data & IFE_PMC_MDIX_STATUS);
2813
2814 /* The following parameters are undefined for 10/100 operation. */
2815 phy->cable_length = E1000_CABLE_LENGTH_UNDEFINED;
2816 phy->local_rx = e1000_1000t_rx_status_undefined;
2817 phy->remote_rx = e1000_1000t_rx_status_undefined;
2818
2819 return E1000_SUCCESS;
2820 }
2821
2822 /**
2823 * e1000_phy_sw_reset_generic - PHY software reset
2824 * @hw: pointer to the HW structure
2825 *
2826 * Does a software reset of the PHY by reading the PHY control register and
2827 * setting/write the control register reset bit to the PHY.
2828 **/
2829 s32 e1000_phy_sw_reset_generic(struct e1000_hw *hw)
2830 {
2831 s32 ret_val;
2832 u16 phy_ctrl;
2833
2834 DEBUGFUNC("e1000_phy_sw_reset_generic");
2835
2836 if (!hw->phy.ops.read_reg)
2837 return E1000_SUCCESS;
2838
2839 ret_val = hw->phy.ops.read_reg(hw, PHY_CONTROL, &phy_ctrl);
2840 if (ret_val)
2841 return ret_val;
2842
2843 phy_ctrl |= MII_CR_RESET;
2844 ret_val = hw->phy.ops.write_reg(hw, PHY_CONTROL, phy_ctrl);
2845 if (ret_val)
2846 return ret_val;
2847
2848 usec_delay(1);
2849
2850 return ret_val;
2851 }
2852
2853 /**
2854 * e1000_phy_hw_reset_generic - PHY hardware reset
2855 * @hw: pointer to the HW structure
2856 *
2857 * Verify the reset block is not blocking us from resetting. Acquire
2858 * semaphore (if necessary) and read/set/write the device control reset
2859 * bit in the PHY. Wait the appropriate delay time for the device to
2860 * reset and release the semaphore (if necessary).
2861 **/
2862 s32 e1000_phy_hw_reset_generic(struct e1000_hw *hw)
2863 {
2864 struct e1000_phy_info *phy = &hw->phy;
2865 s32 ret_val;
2866 u32 ctrl;
2867
2868 DEBUGFUNC("e1000_phy_hw_reset_generic");
2869
2870 if (phy->ops.check_reset_block) {
2871 ret_val = phy->ops.check_reset_block(hw);
2872 if (ret_val)
2873 return E1000_SUCCESS;
2874 }
2875
2876 ret_val = phy->ops.acquire(hw);
2877 if (ret_val)
2878 return ret_val;
2879
2880 ctrl = E1000_READ_REG(hw, E1000_CTRL);
2881 E1000_WRITE_REG(hw, E1000_CTRL, ctrl | E1000_CTRL_PHY_RST);
2882 E1000_WRITE_FLUSH(hw);
2883
2884 usec_delay(phy->reset_delay_us);
2885
2886 E1000_WRITE_REG(hw, E1000_CTRL, ctrl);
2887 E1000_WRITE_FLUSH(hw);
2888
2889 usec_delay(150);
2890
2891 phy->ops.release(hw);
2892
2893 return phy->ops.get_cfg_done(hw);
2894 }
2895
2896 /**
2897 * e1000_get_cfg_done_generic - Generic configuration done
2898 * @hw: pointer to the HW structure
2899 *
2900 * Generic function to wait 10 milli-seconds for configuration to complete
2901 * and return success.
2902 **/
2903 s32 e1000_get_cfg_done_generic(struct e1000_hw E1000_UNUSEDARG *hw)
2904 {
2905 DEBUGFUNC("e1000_get_cfg_done_generic");
2906
2907 msec_delay_irq(10);
2908
2909 return E1000_SUCCESS;
2910 }
2911
2912 /**
2913 * e1000_phy_init_script_igp3 - Inits the IGP3 PHY
2914 * @hw: pointer to the HW structure
2915 *
2916 * Initializes a Intel Gigabit PHY3 when an EEPROM is not present.
2917 **/
2918 s32 e1000_phy_init_script_igp3(struct e1000_hw *hw)
2919 {
2920 DEBUGOUT("Running IGP 3 PHY init script\n");
2921
2922 /* PHY init IGP 3 */
2923 /* Enable rise/fall, 10-mode work in class-A */
2924 hw->phy.ops.write_reg(hw, 0x2F5B, 0x9018);
2925 /* Remove all caps from Replica path filter */
2926 hw->phy.ops.write_reg(hw, 0x2F52, 0x0000);
2927 /* Bias trimming for ADC, AFE and Driver (Default) */
2928 hw->phy.ops.write_reg(hw, 0x2FB1, 0x8B24);
2929 /* Increase Hybrid poly bias */
2930 hw->phy.ops.write_reg(hw, 0x2FB2, 0xF8F0);
2931 /* Add 4% to Tx amplitude in Gig mode */
2932 hw->phy.ops.write_reg(hw, 0x2010, 0x10B0);
2933 /* Disable trimming (TTT) */
2934 hw->phy.ops.write_reg(hw, 0x2011, 0x0000);
2935 /* Poly DC correction to 94.6% + 2% for all channels */
2936 hw->phy.ops.write_reg(hw, 0x20DD, 0x249A);
2937 /* ABS DC correction to 95.9% */
2938 hw->phy.ops.write_reg(hw, 0x20DE, 0x00D3);
2939 /* BG temp curve trim */
2940 hw->phy.ops.write_reg(hw, 0x28B4, 0x04CE);
2941 /* Increasing ADC OPAMP stage 1 currents to max */
2942 hw->phy.ops.write_reg(hw, 0x2F70, 0x29E4);
2943 /* Force 1000 ( required for enabling PHY regs configuration) */
2944 hw->phy.ops.write_reg(hw, 0x0000, 0x0140);
2945 /* Set upd_freq to 6 */
2946 hw->phy.ops.write_reg(hw, 0x1F30, 0x1606);
2947 /* Disable NPDFE */
2948 hw->phy.ops.write_reg(hw, 0x1F31, 0xB814);
2949 /* Disable adaptive fixed FFE (Default) */
2950 hw->phy.ops.write_reg(hw, 0x1F35, 0x002A);
2951 /* Enable FFE hysteresis */
2952 hw->phy.ops.write_reg(hw, 0x1F3E, 0x0067);
2953 /* Fixed FFE for short cable lengths */
2954 hw->phy.ops.write_reg(hw, 0x1F54, 0x0065);
2955 /* Fixed FFE for medium cable lengths */
2956 hw->phy.ops.write_reg(hw, 0x1F55, 0x002A);
2957 /* Fixed FFE for long cable lengths */
2958 hw->phy.ops.write_reg(hw, 0x1F56, 0x002A);
2959 /* Enable Adaptive Clip Threshold */
2960 hw->phy.ops.write_reg(hw, 0x1F72, 0x3FB0);
2961 /* AHT reset limit to 1 */
2962 hw->phy.ops.write_reg(hw, 0x1F76, 0xC0FF);
2963 /* Set AHT master delay to 127 msec */
2964 hw->phy.ops.write_reg(hw, 0x1F77, 0x1DEC);
2965 /* Set scan bits for AHT */
2966 hw->phy.ops.write_reg(hw, 0x1F78, 0xF9EF);
2967 /* Set AHT Preset bits */
2968 hw->phy.ops.write_reg(hw, 0x1F79, 0x0210);
2969 /* Change integ_factor of channel A to 3 */
2970 hw->phy.ops.write_reg(hw, 0x1895, 0x0003);
2971 /* Change prop_factor of channels BCD to 8 */
2972 hw->phy.ops.write_reg(hw, 0x1796, 0x0008);
2973 /* Change cg_icount + enable integbp for channels BCD */
2974 hw->phy.ops.write_reg(hw, 0x1798, 0xD008);
2975 /* Change cg_icount + enable integbp + change prop_factor_master
2976 * to 8 for channel A
2977 */
2978 hw->phy.ops.write_reg(hw, 0x1898, 0xD918);
2979 /* Disable AHT in Slave mode on channel A */
2980 hw->phy.ops.write_reg(hw, 0x187A, 0x0800);
2981 /* Enable LPLU and disable AN to 1000 in non-D0a states,
2982 * Enable SPD+B2B
2983 */
2984 hw->phy.ops.write_reg(hw, 0x0019, 0x008D);
2985 /* Enable restart AN on an1000_dis change */
2986 hw->phy.ops.write_reg(hw, 0x001B, 0x2080);
2987 /* Enable wh_fifo read clock in 10/100 modes */
2988 hw->phy.ops.write_reg(hw, 0x0014, 0x0045);
2989 /* Restart AN, Speed selection is 1000 */
2990 hw->phy.ops.write_reg(hw, 0x0000, 0x1340);
2991
2992 return E1000_SUCCESS;
2993 }
2994
2995 /**
2996 * e1000_get_phy_type_from_id - Get PHY type from id
2997 * @phy_id: phy_id read from the phy
2998 *
2999 * Returns the phy type from the id.
3000 **/
3001 enum e1000_phy_type e1000_get_phy_type_from_id(u32 phy_id)
3002 {
3003 enum e1000_phy_type phy_type = e1000_phy_unknown;
3004
3005 switch (phy_id) {
3006 case M88E1000_I_PHY_ID:
3007 case M88E1000_E_PHY_ID:
3008 case M88E1111_I_PHY_ID:
3009 case M88E1011_I_PHY_ID:
3010 case M88E1543_E_PHY_ID:
3011 case M88E1512_E_PHY_ID:
3012 case I347AT4_E_PHY_ID:
3013 case M88E1112_E_PHY_ID:
3014 case M88E1340M_E_PHY_ID:
3015 phy_type = e1000_phy_m88;
3016 break;
3017 case IGP01E1000_I_PHY_ID: /* IGP 1 & 2 share this */
3018 phy_type = e1000_phy_igp_2;
3019 break;
3020 case GG82563_E_PHY_ID:
3021 phy_type = e1000_phy_gg82563;
3022 break;
3023 case IGP03E1000_E_PHY_ID:
3024 phy_type = e1000_phy_igp_3;
3025 break;
3026 case IFE_E_PHY_ID:
3027 case IFE_PLUS_E_PHY_ID:
3028 case IFE_C_E_PHY_ID:
3029 phy_type = e1000_phy_ife;
3030 break;
3031 case BME1000_E_PHY_ID:
3032 case BME1000_E_PHY_ID_R2:
3033 phy_type = e1000_phy_bm;
3034 break;
3035 case I82578_E_PHY_ID:
3036 phy_type = e1000_phy_82578;
3037 break;
3038 case I82577_E_PHY_ID:
3039 phy_type = e1000_phy_82577;
3040 break;
3041 case I82579_E_PHY_ID:
3042 phy_type = e1000_phy_82579;
3043 break;
3044 case I217_E_PHY_ID:
3045 phy_type = e1000_phy_i217;
3046 break;
3047 case I82580_I_PHY_ID:
3048 phy_type = e1000_phy_82580;
3049 break;
3050 case I210_I_PHY_ID:
3051 phy_type = e1000_phy_i210;
3052 break;
3053 default:
3054 phy_type = e1000_phy_unknown;
3055 break;
3056 }
3057 return phy_type;
3058 }
3059
3060 /**
3061 * e1000_determine_phy_address - Determines PHY address.
3062 * @hw: pointer to the HW structure
3063 *
3064 * This uses a trial and error method to loop through possible PHY
3065 * addresses. It tests each by reading the PHY ID registers and
3066 * checking for a match.
3067 **/
3068 s32 e1000_determine_phy_address(struct e1000_hw *hw)
3069 {
3070 u32 phy_addr = 0;
3071 u32 i;
3072 enum e1000_phy_type phy_type = e1000_phy_unknown;
3073
3074 hw->phy.id = phy_type;
3075
3076 for (phy_addr = 0; phy_addr < E1000_MAX_PHY_ADDR; phy_addr++) {
3077 hw->phy.addr = phy_addr;
3078 i = 0;
3079
3080 do {
3081 e1000_get_phy_id(hw);
3082 phy_type = e1000_get_phy_type_from_id(hw->phy.id);
3083
3084 /* If phy_type is valid, break - we found our
3085 * PHY address
3086 */
3087 if (phy_type != e1000_phy_unknown)
3088 return E1000_SUCCESS;
3089
3090 msec_delay(1);
3091 i++;
3092 } while (i < 10);
3093 }
3094
3095 return -E1000_ERR_PHY_TYPE;
3096 }
3097
3098 /**
3099 * e1000_get_phy_addr_for_bm_page - Retrieve PHY page address
3100 * @page: page to access
3101 * @reg: register to access
3102 *
3103 * Returns the phy address for the page requested.
3104 **/
3105 static u32 e1000_get_phy_addr_for_bm_page(u32 page, u32 reg)
3106 {
3107 u32 phy_addr = 2;
3108
3109 if ((page >= 768) || (page == 0 && reg == 25) || (reg == 31))
3110 phy_addr = 1;
3111
3112 return phy_addr;
3113 }
3114
3115 /**
3116 * e1000_write_phy_reg_bm - Write BM PHY register
3117 * @hw: pointer to the HW structure
3118 * @offset: register offset to write to
3119 * @data: data to write at register offset
3120 *
3121 * Acquires semaphore, if necessary, then writes the data to PHY register
3122 * at the offset. Release any acquired semaphores before exiting.
3123 **/
3124 s32 e1000_write_phy_reg_bm(struct e1000_hw *hw, u32 offset, u16 data)
3125 {
3126 s32 ret_val;
3127 u32 page = offset >> IGP_PAGE_SHIFT;
3128
3129 DEBUGFUNC("e1000_write_phy_reg_bm");
3130
3131 ret_val = hw->phy.ops.acquire(hw);
3132 if (ret_val)
3133 return ret_val;
3134
3135 /* Page 800 works differently than the rest so it has its own func */
3136 if (page == BM_WUC_PAGE) {
3137 ret_val = e1000_access_phy_wakeup_reg_bm(hw, offset, &data,
3138 false, false);
3139 goto release;
3140 }
3141
3142 hw->phy.addr = e1000_get_phy_addr_for_bm_page(page, offset);
3143
3144 if (offset > MAX_PHY_MULTI_PAGE_REG) {
3145 u32 page_shift, page_select;
3146
3147 /* Page select is register 31 for phy address 1 and 22 for
3148 * phy address 2 and 3. Page select is shifted only for
3149 * phy address 1.
3150 */
3151 if (hw->phy.addr == 1) {
3152 page_shift = IGP_PAGE_SHIFT;
3153 page_select = IGP01E1000_PHY_PAGE_SELECT;
3154 } else {
3155 page_shift = 0;
3156 page_select = BM_PHY_PAGE_SELECT;
3157 }
3158
3159 /* Page is shifted left, PHY expects (page x 32) */
3160 ret_val = e1000_write_phy_reg_mdic(hw, page_select,
3161 (page << page_shift));
3162 if (ret_val)
3163 goto release;
3164 }
3165
3166 ret_val = e1000_write_phy_reg_mdic(hw, MAX_PHY_REG_ADDRESS & offset,
3167 data);
3168
3169 release:
3170 hw->phy.ops.release(hw);
3171 return ret_val;
3172 }
3173
3174 /**
3175 * e1000_read_phy_reg_bm - Read BM PHY register
3176 * @hw: pointer to the HW structure
3177 * @offset: register offset to be read
3178 * @data: pointer to the read data
3179 *
3180 * Acquires semaphore, if necessary, then reads the PHY register at offset
3181 * and storing the retrieved information in data. Release any acquired
3182 * semaphores before exiting.
3183 **/
3184 s32 e1000_read_phy_reg_bm(struct e1000_hw *hw, u32 offset, u16 *data)
3185 {
3186 s32 ret_val;
3187 u32 page = offset >> IGP_PAGE_SHIFT;
3188
3189 DEBUGFUNC("e1000_read_phy_reg_bm");
3190
3191 ret_val = hw->phy.ops.acquire(hw);
3192 if (ret_val)
3193 return ret_val;
3194
3195 /* Page 800 works differently than the rest so it has its own func */
3196 if (page == BM_WUC_PAGE) {
3197 ret_val = e1000_access_phy_wakeup_reg_bm(hw, offset, data,
3198 true, false);
3199 goto release;
3200 }
3201
3202 hw->phy.addr = e1000_get_phy_addr_for_bm_page(page, offset);
3203
3204 if (offset > MAX_PHY_MULTI_PAGE_REG) {
3205 u32 page_shift, page_select;
3206
3207 /* Page select is register 31 for phy address 1 and 22 for
3208 * phy address 2 and 3. Page select is shifted only for
3209 * phy address 1.
3210 */
3211 if (hw->phy.addr == 1) {
3212 page_shift = IGP_PAGE_SHIFT;
3213 page_select = IGP01E1000_PHY_PAGE_SELECT;
3214 } else {
3215 page_shift = 0;
3216 page_select = BM_PHY_PAGE_SELECT;
3217 }
3218
3219 /* Page is shifted left, PHY expects (page x 32) */
3220 ret_val = e1000_write_phy_reg_mdic(hw, page_select,
3221 (page << page_shift));
3222 if (ret_val)
3223 goto release;
3224 }
3225
3226 ret_val = e1000_read_phy_reg_mdic(hw, MAX_PHY_REG_ADDRESS & offset,
3227 data);
3228 release:
3229 hw->phy.ops.release(hw);
3230 return ret_val;
3231 }
3232
3233 /**
3234 * e1000_read_phy_reg_bm2 - Read BM PHY register
3235 * @hw: pointer to the HW structure
3236 * @offset: register offset to be read
3237 * @data: pointer to the read data
3238 *
3239 * Acquires semaphore, if necessary, then reads the PHY register at offset
3240 * and storing the retrieved information in data. Release any acquired
3241 * semaphores before exiting.
3242 **/
3243 s32 e1000_read_phy_reg_bm2(struct e1000_hw *hw, u32 offset, u16 *data)
3244 {
3245 s32 ret_val;
3246 u16 page = (u16)(offset >> IGP_PAGE_SHIFT);
3247
3248 DEBUGFUNC("e1000_read_phy_reg_bm2");
3249
3250 ret_val = hw->phy.ops.acquire(hw);
3251 if (ret_val)
3252 return ret_val;
3253
3254 /* Page 800 works differently than the rest so it has its own func */
3255 if (page == BM_WUC_PAGE) {
3256 ret_val = e1000_access_phy_wakeup_reg_bm(hw, offset, data,
3257 true, false);
3258 goto release;
3259 }
3260
3261 hw->phy.addr = 1;
3262
3263 if (offset > MAX_PHY_MULTI_PAGE_REG) {
3264 /* Page is shifted left, PHY expects (page x 32) */
3265 ret_val = e1000_write_phy_reg_mdic(hw, BM_PHY_PAGE_SELECT,
3266 page);
3267
3268 if (ret_val)
3269 goto release;
3270 }
3271
3272 ret_val = e1000_read_phy_reg_mdic(hw, MAX_PHY_REG_ADDRESS & offset,
3273 data);
3274 release:
3275 hw->phy.ops.release(hw);
3276 return ret_val;
3277 }
3278
3279 /**
3280 * e1000_write_phy_reg_bm2 - Write BM PHY register
3281 * @hw: pointer to the HW structure
3282 * @offset: register offset to write to
3283 * @data: data to write at register offset
3284 *
3285 * Acquires semaphore, if necessary, then writes the data to PHY register
3286 * at the offset. Release any acquired semaphores before exiting.
3287 **/
3288 s32 e1000_write_phy_reg_bm2(struct e1000_hw *hw, u32 offset, u16 data)
3289 {
3290 s32 ret_val;
3291 u16 page = (u16)(offset >> IGP_PAGE_SHIFT);
3292
3293 DEBUGFUNC("e1000_write_phy_reg_bm2");
3294
3295 ret_val = hw->phy.ops.acquire(hw);
3296 if (ret_val)
3297 return ret_val;
3298
3299 /* Page 800 works differently than the rest so it has its own func */
3300 if (page == BM_WUC_PAGE) {
3301 ret_val = e1000_access_phy_wakeup_reg_bm(hw, offset, &data,
3302 false, false);
3303 goto release;
3304 }
3305
3306 hw->phy.addr = 1;
3307
3308 if (offset > MAX_PHY_MULTI_PAGE_REG) {
3309 /* Page is shifted left, PHY expects (page x 32) */
3310 ret_val = e1000_write_phy_reg_mdic(hw, BM_PHY_PAGE_SELECT,
3311 page);
3312
3313 if (ret_val)
3314 goto release;
3315 }
3316
3317 ret_val = e1000_write_phy_reg_mdic(hw, MAX_PHY_REG_ADDRESS & offset,
3318 data);
3319
3320 release:
3321 hw->phy.ops.release(hw);
3322 return ret_val;
3323 }
3324
3325 /**
3326 * e1000_enable_phy_wakeup_reg_access_bm - enable access to BM wakeup registers
3327 * @hw: pointer to the HW structure
3328 * @phy_reg: pointer to store original contents of BM_WUC_ENABLE_REG
3329 *
3330 * Assumes semaphore already acquired and phy_reg points to a valid memory
3331 * address to store contents of the BM_WUC_ENABLE_REG register.
3332 **/
3333 s32 e1000_enable_phy_wakeup_reg_access_bm(struct e1000_hw *hw, u16 *phy_reg)
3334 {
3335 s32 ret_val;
3336 u16 temp;
3337
3338 DEBUGFUNC("e1000_enable_phy_wakeup_reg_access_bm");
3339
3340 if (!phy_reg)
3341 return -E1000_ERR_PARAM;
3342
3343 /* All page select, port ctrl and wakeup registers use phy address 1 */
3344 hw->phy.addr = 1;
3345
3346 /* Select Port Control Registers page */
3347 ret_val = e1000_set_page_igp(hw, (BM_PORT_CTRL_PAGE << IGP_PAGE_SHIFT));
3348 if (ret_val) {
3349 DEBUGOUT("Could not set Port Control page\n");
3350 return ret_val;
3351 }
3352
3353 ret_val = e1000_read_phy_reg_mdic(hw, BM_WUC_ENABLE_REG, phy_reg);
3354 if (ret_val) {
3355 DEBUGOUT2("Could not read PHY register %d.%d\n",
3356 BM_PORT_CTRL_PAGE, BM_WUC_ENABLE_REG);
3357 return ret_val;
3358 }
3359
3360 /* Enable both PHY wakeup mode and Wakeup register page writes.
3361 * Prevent a power state change by disabling ME and Host PHY wakeup.
3362 */
3363 temp = *phy_reg;
3364 temp |= BM_WUC_ENABLE_BIT;
3365 temp &= ~(BM_WUC_ME_WU_BIT | BM_WUC_HOST_WU_BIT);
3366
3367 ret_val = e1000_write_phy_reg_mdic(hw, BM_WUC_ENABLE_REG, temp);
3368 if (ret_val) {
3369 DEBUGOUT2("Could not write PHY register %d.%d\n",
3370 BM_PORT_CTRL_PAGE, BM_WUC_ENABLE_REG);
3371 return ret_val;
3372 }
3373
3374 /* Select Host Wakeup Registers page - caller now able to write
3375 * registers on the Wakeup registers page
3376 */
3377 return e1000_set_page_igp(hw, (BM_WUC_PAGE << IGP_PAGE_SHIFT));
3378 }
3379
3380 /**
3381 * e1000_disable_phy_wakeup_reg_access_bm - disable access to BM wakeup regs
3382 * @hw: pointer to the HW structure
3383 * @phy_reg: pointer to original contents of BM_WUC_ENABLE_REG
3384 *
3385 * Restore BM_WUC_ENABLE_REG to its original value.
3386 *
3387 * Assumes semaphore already acquired and *phy_reg is the contents of the
3388 * BM_WUC_ENABLE_REG before register(s) on BM_WUC_PAGE were accessed by
3389 * caller.
3390 **/
3391 s32 e1000_disable_phy_wakeup_reg_access_bm(struct e1000_hw *hw, u16 *phy_reg)
3392 {
3393 s32 ret_val;
3394
3395 DEBUGFUNC("e1000_disable_phy_wakeup_reg_access_bm");
3396
3397 if (!phy_reg)
3398 return -E1000_ERR_PARAM;
3399
3400 /* Select Port Control Registers page */
3401 ret_val = e1000_set_page_igp(hw, (BM_PORT_CTRL_PAGE << IGP_PAGE_SHIFT));
3402 if (ret_val) {
3403 DEBUGOUT("Could not set Port Control page\n");
3404 return ret_val;
3405 }
3406
3407 /* Restore 769.17 to its original value */
3408 ret_val = e1000_write_phy_reg_mdic(hw, BM_WUC_ENABLE_REG, *phy_reg);
3409 if (ret_val)
3410 DEBUGOUT2("Could not restore PHY register %d.%d\n",
3411 BM_PORT_CTRL_PAGE, BM_WUC_ENABLE_REG);
3412
3413 return ret_val;
3414 }
3415
3416 /**
3417 * e1000_access_phy_wakeup_reg_bm - Read/write BM PHY wakeup register
3418 * @hw: pointer to the HW structure
3419 * @offset: register offset to be read or written
3420 * @data: pointer to the data to read or write
3421 * @read: determines if operation is read or write
3422 * @page_set: BM_WUC_PAGE already set and access enabled
3423 *
3424 * Read the PHY register at offset and store the retrieved information in
3425 * data, or write data to PHY register at offset. Note the procedure to
3426 * access the PHY wakeup registers is different than reading the other PHY
3427 * registers. It works as such:
3428 * 1) Set 769.17.2 (page 769, register 17, bit 2) = 1
3429 * 2) Set page to 800 for host (801 if we were manageability)
3430 * 3) Write the address using the address opcode (0x11)
3431 * 4) Read or write the data using the data opcode (0x12)
3432 * 5) Restore 769.17.2 to its original value
3433 *
3434 * Steps 1 and 2 are done by e1000_enable_phy_wakeup_reg_access_bm() and
3435 * step 5 is done by e1000_disable_phy_wakeup_reg_access_bm().
3436 *
3437 * Assumes semaphore is already acquired. When page_set==true, assumes
3438 * the PHY page is set to BM_WUC_PAGE (i.e. a function in the call stack
3439 * is responsible for calls to e1000_[enable|disable]_phy_wakeup_reg_bm()).
3440 **/
3441 static s32 e1000_access_phy_wakeup_reg_bm(struct e1000_hw *hw, u32 offset,
3442 u16 *data, bool read, bool page_set)
3443 {
3444 s32 ret_val;
3445 u16 reg = BM_PHY_REG_NUM(offset);
3446 u16 page = BM_PHY_REG_PAGE(offset);
3447 u16 phy_reg = 0;
3448
3449 DEBUGFUNC("e1000_access_phy_wakeup_reg_bm");
3450
3451 /* Gig must be disabled for MDIO accesses to Host Wakeup reg page */
3452 if ((hw->mac.type == e1000_pchlan) &&
3453 (!(E1000_READ_REG(hw, E1000_PHY_CTRL) & E1000_PHY_CTRL_GBE_DISABLE)))
3454 DEBUGOUT1("Attempting to access page %d while gig enabled.\n",
3455 page);
3456
3457 if (!page_set) {
3458 /* Enable access to PHY wakeup registers */
3459 ret_val = e1000_enable_phy_wakeup_reg_access_bm(hw, &phy_reg);
3460 if (ret_val) {
3461 DEBUGOUT("Could not enable PHY wakeup reg access\n");
3462 return ret_val;
3463 }
3464 }
3465
3466 DEBUGOUT2("Accessing PHY page %d reg 0x%x\n", page, reg);
3467
3468 /* Write the Wakeup register page offset value using opcode 0x11 */
3469 ret_val = e1000_write_phy_reg_mdic(hw, BM_WUC_ADDRESS_OPCODE, reg);
3470 if (ret_val) {
3471 DEBUGOUT1("Could not write address opcode to page %d\n", page);
3472 return ret_val;
3473 }
3474
3475 if (read) {
3476 /* Read the Wakeup register page value using opcode 0x12 */
3477 ret_val = e1000_read_phy_reg_mdic(hw, BM_WUC_DATA_OPCODE,
3478 data);
3479 } else {
3480 /* Write the Wakeup register page value using opcode 0x12 */
3481 ret_val = e1000_write_phy_reg_mdic(hw, BM_WUC_DATA_OPCODE,
3482 *data);
3483 }
3484
3485 if (ret_val) {
3486 DEBUGOUT2("Could not access PHY reg %d.%d\n", page, reg);
3487 return ret_val;
3488 }
3489
3490 if (!page_set)
3491 ret_val = e1000_disable_phy_wakeup_reg_access_bm(hw, &phy_reg);
3492
3493 return ret_val;
3494 }
3495
3496 /**
3497 * e1000_power_up_phy_copper - Restore copper link in case of PHY power down
3498 * @hw: pointer to the HW structure
3499 *
3500 * In the case of a PHY power down to save power, or to turn off link during a
3501 * driver unload, or wake on lan is not enabled, restore the link to previous
3502 * settings.
3503 **/
3504 void e1000_power_up_phy_copper(struct e1000_hw *hw)
3505 {
3506 u16 mii_reg = 0;
3507
3508 /* The PHY will retain its settings across a power down/up cycle */
3509 hw->phy.ops.read_reg(hw, PHY_CONTROL, &mii_reg);
3510 mii_reg &= ~MII_CR_POWER_DOWN;
3511 hw->phy.ops.write_reg(hw, PHY_CONTROL, mii_reg);
3512 }
3513
3514 /**
3515 * e1000_power_down_phy_copper - Restore copper link in case of PHY power down
3516 * @hw: pointer to the HW structure
3517 *
3518 * In the case of a PHY power down to save power, or to turn off link during a
3519 * driver unload, or wake on lan is not enabled, restore the link to previous
3520 * settings.
3521 **/
3522 void e1000_power_down_phy_copper(struct e1000_hw *hw)
3523 {
3524 u16 mii_reg = 0;
3525
3526 /* The PHY will retain its settings across a power down/up cycle */
3527 hw->phy.ops.read_reg(hw, PHY_CONTROL, &mii_reg);
3528 mii_reg |= MII_CR_POWER_DOWN;
3529 hw->phy.ops.write_reg(hw, PHY_CONTROL, mii_reg);
3530 msec_delay(1);
3531 }
3532
3533 /**
3534 * __e1000_read_phy_reg_hv - Read HV PHY register
3535 * @hw: pointer to the HW structure
3536 * @offset: register offset to be read
3537 * @data: pointer to the read data
3538 * @locked: semaphore has already been acquired or not
3539 * @page_set: BM_WUC_PAGE already set and access enabled
3540 *
3541 * Acquires semaphore, if necessary, then reads the PHY register at offset
3542 * and stores the retrieved information in data. Release any acquired
3543 * semaphore before exiting.
3544 **/
3545 static s32 __e1000_read_phy_reg_hv(struct e1000_hw *hw, u32 offset, u16 *data,
3546 bool locked, bool page_set)
3547 {
3548 s32 ret_val;
3549 u16 page = BM_PHY_REG_PAGE(offset);
3550 u16 reg = BM_PHY_REG_NUM(offset);
3551 u32 phy_addr = hw->phy.addr = e1000_get_phy_addr_for_hv_page(page);
3552
3553 DEBUGFUNC("__e1000_read_phy_reg_hv");
3554
3555 if (!locked) {
3556 ret_val = hw->phy.ops.acquire(hw);
3557 if (ret_val)
3558 return ret_val;
3559 }
3560 /* Page 800 works differently than the rest so it has its own func */
3561 if (page == BM_WUC_PAGE) {
3562 ret_val = e1000_access_phy_wakeup_reg_bm(hw, offset, data,
3563 true, page_set);
3564 goto out;
3565 }
3566
3567 if (page > 0 && page < HV_INTC_FC_PAGE_START) {
3568 ret_val = e1000_access_phy_debug_regs_hv(hw, offset,
3569 data, true);
3570 goto out;
3571 }
3572
3573 if (!page_set) {
3574 if (page == HV_INTC_FC_PAGE_START)
3575 page = 0;
3576
3577 if (reg > MAX_PHY_MULTI_PAGE_REG) {
3578 /* Page is shifted left, PHY expects (page x 32) */
3579 ret_val = e1000_set_page_igp(hw,
3580 (page << IGP_PAGE_SHIFT));
3581
3582 hw->phy.addr = phy_addr;
3583
3584 if (ret_val)
3585 goto out;
3586 }
3587 }
3588
3589 DEBUGOUT3("reading PHY page %d (or 0x%x shifted) reg 0x%x\n", page,
3590 page << IGP_PAGE_SHIFT, reg);
3591
3592 ret_val = e1000_read_phy_reg_mdic(hw, MAX_PHY_REG_ADDRESS & reg,
3593 data);
3594 out:
3595 if (!locked)
3596 hw->phy.ops.release(hw);
3597
3598 return ret_val;
3599 }
3600
3601 /**
3602 * e1000_read_phy_reg_hv - Read HV PHY register
3603 * @hw: pointer to the HW structure
3604 * @offset: register offset to be read
3605 * @data: pointer to the read data
3606 *
3607 * Acquires semaphore then reads the PHY register at offset and stores
3608 * the retrieved information in data. Release the acquired semaphore
3609 * before exiting.
3610 **/
3611 s32 e1000_read_phy_reg_hv(struct e1000_hw *hw, u32 offset, u16 *data)
3612 {
3613 return __e1000_read_phy_reg_hv(hw, offset, data, false, false);
3614 }
3615
3616 /**
3617 * e1000_read_phy_reg_hv_locked - Read HV PHY register
3618 * @hw: pointer to the HW structure
3619 * @offset: register offset to be read
3620 * @data: pointer to the read data
3621 *
3622 * Reads the PHY register at offset and stores the retrieved information
3623 * in data. Assumes semaphore already acquired.
3624 **/
3625 s32 e1000_read_phy_reg_hv_locked(struct e1000_hw *hw, u32 offset, u16 *data)
3626 {
3627 return __e1000_read_phy_reg_hv(hw, offset, data, true, false);
3628 }
3629
3630 /**
3631 * e1000_read_phy_reg_page_hv - Read HV PHY register
3632 * @hw: pointer to the HW structure
3633 * @offset: register offset to write to
3634 * @data: data to write at register offset
3635 *
3636 * Reads the PHY register at offset and stores the retrieved information
3637 * in data. Assumes semaphore already acquired and page already set.
3638 **/
3639 s32 e1000_read_phy_reg_page_hv(struct e1000_hw *hw, u32 offset, u16 *data)
3640 {
3641 return __e1000_read_phy_reg_hv(hw, offset, data, true, true);
3642 }
3643
3644 /**
3645 * __e1000_write_phy_reg_hv - Write HV PHY register
3646 * @hw: pointer to the HW structure
3647 * @offset: register offset to write to
3648 * @data: data to write at register offset
3649 * @locked: semaphore has already been acquired or not
3650 * @page_set: BM_WUC_PAGE already set and access enabled
3651 *
3652 * Acquires semaphore, if necessary, then writes the data to PHY register
3653 * at the offset. Release any acquired semaphores before exiting.
3654 **/
3655 static s32 __e1000_write_phy_reg_hv(struct e1000_hw *hw, u32 offset, u16 data,
3656 bool locked, bool page_set)
3657 {
3658 s32 ret_val;
3659 u16 page = BM_PHY_REG_PAGE(offset);
3660 u16 reg = BM_PHY_REG_NUM(offset);
3661 u32 phy_addr = hw->phy.addr = e1000_get_phy_addr_for_hv_page(page);
3662
3663 DEBUGFUNC("__e1000_write_phy_reg_hv");
3664
3665 if (!locked) {
3666 ret_val = hw->phy.ops.acquire(hw);
3667 if (ret_val)
3668 return ret_val;
3669 }
3670 /* Page 800 works differently than the rest so it has its own func */
3671 if (page == BM_WUC_PAGE) {
3672 ret_val = e1000_access_phy_wakeup_reg_bm(hw, offset, &data,
3673 false, page_set);
3674 goto out;
3675 }
3676
3677 if (page > 0 && page < HV_INTC_FC_PAGE_START) {
3678 ret_val = e1000_access_phy_debug_regs_hv(hw, offset,
3679 &data, false);
3680 goto out;
3681 }
3682
3683 if (!page_set) {
3684 if (page == HV_INTC_FC_PAGE_START)
3685 page = 0;
3686
3687 /* Workaround MDIO accesses being disabled after entering IEEE
3688 * Power Down (when bit 11 of the PHY Control register is set)
3689 */
3690 if ((hw->phy.type == e1000_phy_82578) &&
3691 (hw->phy.revision >= 1) &&
3692 (hw->phy.addr == 2) &&
3693 !(MAX_PHY_REG_ADDRESS & reg) &&
3694 (data & (1 << 11))) {
3695 u16 data2 = 0x7EFF;
3696 ret_val = e1000_access_phy_debug_regs_hv(hw,
3697 (1 << 6) | 0x3,
3698 &data2, false);
3699 if (ret_val)
3700 goto out;
3701 }
3702
3703 if (reg > MAX_PHY_MULTI_PAGE_REG) {
3704 /* Page is shifted left, PHY expects (page x 32) */
3705 ret_val = e1000_set_page_igp(hw,
3706 (page << IGP_PAGE_SHIFT));
3707
3708 hw->phy.addr = phy_addr;
3709
3710 if (ret_val)
3711 goto out;
3712 }
3713 }
3714
3715 DEBUGOUT3("writing PHY page %d (or 0x%x shifted) reg 0x%x\n", page,
3716 page << IGP_PAGE_SHIFT, reg);
3717
3718 ret_val = e1000_write_phy_reg_mdic(hw, MAX_PHY_REG_ADDRESS & reg,
3719 data);
3720
3721 out:
3722 if (!locked)
3723 hw->phy.ops.release(hw);
3724
3725 return ret_val;
3726 }
3727
3728 /**
3729 * e1000_write_phy_reg_hv - Write HV PHY register
3730 * @hw: pointer to the HW structure
3731 * @offset: register offset to write to
3732 * @data: data to write at register offset
3733 *
3734 * Acquires semaphore then writes the data to PHY register at the offset.
3735 * Release the acquired semaphores before exiting.
3736 **/
3737 s32 e1000_write_phy_reg_hv(struct e1000_hw *hw, u32 offset, u16 data)
3738 {
3739 return __e1000_write_phy_reg_hv(hw, offset, data, false, false);
3740 }
3741
3742 /**
3743 * e1000_write_phy_reg_hv_locked - Write HV PHY register
3744 * @hw: pointer to the HW structure
3745 * @offset: register offset to write to
3746 * @data: data to write at register offset
3747 *
3748 * Writes the data to PHY register at the offset. Assumes semaphore
3749 * already acquired.
3750 **/
3751 s32 e1000_write_phy_reg_hv_locked(struct e1000_hw *hw, u32 offset, u16 data)
3752 {
3753 return __e1000_write_phy_reg_hv(hw, offset, data, true, false);
3754 }
3755
3756 /**
3757 * e1000_write_phy_reg_page_hv - Write HV PHY register
3758 * @hw: pointer to the HW structure
3759 * @offset: register offset to write to
3760 * @data: data to write at register offset
3761 *
3762 * Writes the data to PHY register at the offset. Assumes semaphore
3763 * already acquired and page already set.
3764 **/
3765 s32 e1000_write_phy_reg_page_hv(struct e1000_hw *hw, u32 offset, u16 data)
3766 {
3767 return __e1000_write_phy_reg_hv(hw, offset, data, true, true);
3768 }
3769
3770 /**
3771 * e1000_get_phy_addr_for_hv_page - Get PHY adrress based on page
3772 * @page: page to be accessed
3773 **/
3774 static u32 e1000_get_phy_addr_for_hv_page(u32 page)
3775 {
3776 u32 phy_addr = 2;
3777
3778 if (page >= HV_INTC_FC_PAGE_START)
3779 phy_addr = 1;
3780
3781 return phy_addr;
3782 }
3783
3784 /**
3785 * e1000_access_phy_debug_regs_hv - Read HV PHY vendor specific high registers
3786 * @hw: pointer to the HW structure
3787 * @offset: register offset to be read or written
3788 * @data: pointer to the data to be read or written
3789 * @read: determines if operation is read or write
3790 *
3791 * Reads the PHY register at offset and stores the retreived information
3792 * in data. Assumes semaphore already acquired. Note that the procedure
3793 * to access these regs uses the address port and data port to read/write.
3794 * These accesses done with PHY address 2 and without using pages.
3795 **/
3796 static s32 e1000_access_phy_debug_regs_hv(struct e1000_hw *hw, u32 offset,
3797 u16 *data, bool read)
3798 {
3799 s32 ret_val;
3800 u32 addr_reg;
3801 u32 data_reg;
3802
3803 DEBUGFUNC("e1000_access_phy_debug_regs_hv");
3804
3805 /* This takes care of the difference with desktop vs mobile phy */
3806 addr_reg = ((hw->phy.type == e1000_phy_82578) ?
3807 I82578_ADDR_REG : I82577_ADDR_REG);
3808 data_reg = addr_reg + 1;
3809
3810 /* All operations in this function are phy address 2 */
3811 hw->phy.addr = 2;
3812
3813 /* masking with 0x3F to remove the page from offset */
3814 ret_val = e1000_write_phy_reg_mdic(hw, addr_reg, (u16)offset & 0x3F);
3815 if (ret_val) {
3816 DEBUGOUT("Could not write the Address Offset port register\n");
3817 return ret_val;
3818 }
3819
3820 /* Read or write the data value next */
3821 if (read)
3822 ret_val = e1000_read_phy_reg_mdic(hw, data_reg, data);
3823 else
3824 ret_val = e1000_write_phy_reg_mdic(hw, data_reg, *data);
3825
3826 if (ret_val)
3827 DEBUGOUT("Could not access the Data port register\n");
3828
3829 return ret_val;
3830 }
3831
3832 /**
3833 * e1000_link_stall_workaround_hv - Si workaround
3834 * @hw: pointer to the HW structure
3835 *
3836 * This function works around a Si bug where the link partner can get
3837 * a link up indication before the PHY does. If small packets are sent
3838 * by the link partner they can be placed in the packet buffer without
3839 * being properly accounted for by the PHY and will stall preventing
3840 * further packets from being received. The workaround is to clear the
3841 * packet buffer after the PHY detects link up.
3842 **/
3843 s32 e1000_link_stall_workaround_hv(struct e1000_hw *hw)
3844 {
3845 s32 ret_val = E1000_SUCCESS;
3846 u16 data;
3847
3848 DEBUGFUNC("e1000_link_stall_workaround_hv");
3849
3850 if (hw->phy.type != e1000_phy_82578)
3851 return E1000_SUCCESS;
3852
3853 /* Do not apply workaround if in PHY loopback bit 14 set */
3854 hw->phy.ops.read_reg(hw, PHY_CONTROL, &data);
3855 if (data & PHY_CONTROL_LB)
3856 return E1000_SUCCESS;
3857
3858 /* check if link is up and at 1Gbps */
3859 ret_val = hw->phy.ops.read_reg(hw, BM_CS_STATUS, &data);
3860 if (ret_val)
3861 return ret_val;
3862
3863 data &= (BM_CS_STATUS_LINK_UP | BM_CS_STATUS_RESOLVED |
3864 BM_CS_STATUS_SPEED_MASK);
3865
3866 if (data != (BM_CS_STATUS_LINK_UP | BM_CS_STATUS_RESOLVED |
3867 BM_CS_STATUS_SPEED_1000))
3868 return E1000_SUCCESS;
3869
3870 msec_delay(200);
3871
3872 /* flush the packets in the fifo buffer */
3873 ret_val = hw->phy.ops.write_reg(hw, HV_MUX_DATA_CTRL,
3874 (HV_MUX_DATA_CTRL_GEN_TO_MAC |
3875 HV_MUX_DATA_CTRL_FORCE_SPEED));
3876 if (ret_val)
3877 return ret_val;
3878
3879 return hw->phy.ops.write_reg(hw, HV_MUX_DATA_CTRL,
3880 HV_MUX_DATA_CTRL_GEN_TO_MAC);
3881 }
3882
3883 /**
3884 * e1000_check_polarity_82577 - Checks the polarity.
3885 * @hw: pointer to the HW structure
3886 *
3887 * Success returns 0, Failure returns -E1000_ERR_PHY (-2)
3888 *
3889 * Polarity is determined based on the PHY specific status register.
3890 **/
3891 s32 e1000_check_polarity_82577(struct e1000_hw *hw)
3892 {
3893 struct e1000_phy_info *phy = &hw->phy;
3894 s32 ret_val;
3895 u16 data;
3896
3897 DEBUGFUNC("e1000_check_polarity_82577");
3898
3899 ret_val = phy->ops.read_reg(hw, I82577_PHY_STATUS_2, &data);
3900
3901 if (!ret_val)
3902 phy->cable_polarity = ((data & I82577_PHY_STATUS2_REV_POLARITY)
3903 ? e1000_rev_polarity_reversed
3904 : e1000_rev_polarity_normal);
3905
3906 return ret_val;
3907 }
3908
3909 /**
3910 * e1000_phy_force_speed_duplex_82577 - Force speed/duplex for I82577 PHY
3911 * @hw: pointer to the HW structure
3912 *
3913 * Calls the PHY setup function to force speed and duplex.
3914 **/
3915 s32 e1000_phy_force_speed_duplex_82577(struct e1000_hw *hw)
3916 {
3917 struct e1000_phy_info *phy = &hw->phy;
3918 s32 ret_val;
3919 u16 phy_data;
3920 bool link;
3921
3922 DEBUGFUNC("e1000_phy_force_speed_duplex_82577");
3923
3924 ret_val = phy->ops.read_reg(hw, PHY_CONTROL, &phy_data);
3925 if (ret_val)
3926 return ret_val;
3927
3928 e1000_phy_force_speed_duplex_setup(hw, &phy_data);
3929
3930 ret_val = phy->ops.write_reg(hw, PHY_CONTROL, phy_data);
3931 if (ret_val)
3932 return ret_val;
3933
3934 usec_delay(1);
3935
3936 if (phy->autoneg_wait_to_complete) {
3937 DEBUGOUT("Waiting for forced speed/duplex link on 82577 phy\n");
3938
3939 ret_val = e1000_phy_has_link_generic(hw, PHY_FORCE_LIMIT,
3940 100000, &link);
3941 if (ret_val)
3942 return ret_val;
3943
3944 if (!link)
3945 DEBUGOUT("Link taking longer than expected.\n");
3946
3947 /* Try once more */
3948 ret_val = e1000_phy_has_link_generic(hw, PHY_FORCE_LIMIT,
3949 100000, &link);
3950 }
3951
3952 return ret_val;
3953 }
3954
3955 /**
3956 * e1000_get_phy_info_82577 - Retrieve I82577 PHY information
3957 * @hw: pointer to the HW structure
3958 *
3959 * Read PHY status to determine if link is up. If link is up, then
3960 * set/determine 10base-T extended distance and polarity correction. Read
3961 * PHY port status to determine MDI/MDIx and speed. Based on the speed,
3962 * determine on the cable length, local and remote receiver.
3963 **/
3964 s32 e1000_get_phy_info_82577(struct e1000_hw *hw)
3965 {
3966 struct e1000_phy_info *phy = &hw->phy;
3967 s32 ret_val;
3968 u16 data;
3969 bool link;
3970
3971 DEBUGFUNC("e1000_get_phy_info_82577");
3972
3973 ret_val = e1000_phy_has_link_generic(hw, 1, 0, &link);
3974 if (ret_val)
3975 return ret_val;
3976
3977 if (!link) {
3978 DEBUGOUT("Phy info is only valid if link is up\n");
3979 return -E1000_ERR_CONFIG;
3980 }
3981
3982 phy->polarity_correction = true;
3983
3984 ret_val = e1000_check_polarity_82577(hw);
3985 if (ret_val)
3986 return ret_val;
3987
3988 ret_val = phy->ops.read_reg(hw, I82577_PHY_STATUS_2, &data);
3989 if (ret_val)
3990 return ret_val;
3991
3992 phy->is_mdix = !!(data & I82577_PHY_STATUS2_MDIX);
3993
3994 if ((data & I82577_PHY_STATUS2_SPEED_MASK) ==
3995 I82577_PHY_STATUS2_SPEED_1000MBPS) {
3996 ret_val = hw->phy.ops.get_cable_length(hw);
3997 if (ret_val)
3998 return ret_val;
3999
4000 ret_val = phy->ops.read_reg(hw, PHY_1000T_STATUS, &data);
4001 if (ret_val)
4002 return ret_val;
4003
4004 phy->local_rx = (data & SR_1000T_LOCAL_RX_STATUS)
4005 ? e1000_1000t_rx_status_ok
4006 : e1000_1000t_rx_status_not_ok;
4007
4008 phy->remote_rx = (data & SR_1000T_REMOTE_RX_STATUS)
4009 ? e1000_1000t_rx_status_ok
4010 : e1000_1000t_rx_status_not_ok;
4011 } else {
4012 phy->cable_length = E1000_CABLE_LENGTH_UNDEFINED;
4013 phy->local_rx = e1000_1000t_rx_status_undefined;
4014 phy->remote_rx = e1000_1000t_rx_status_undefined;
4015 }
4016
4017 return E1000_SUCCESS;
4018 }
4019
4020 /**
4021 * e1000_get_cable_length_82577 - Determine cable length for 82577 PHY
4022 * @hw: pointer to the HW structure
4023 *
4024 * Reads the diagnostic status register and verifies result is valid before
4025 * placing it in the phy_cable_length field.
4026 **/
4027 s32 e1000_get_cable_length_82577(struct e1000_hw *hw)
4028 {
4029 struct e1000_phy_info *phy = &hw->phy;
4030 s32 ret_val;
4031 u16 phy_data, length;
4032
4033 DEBUGFUNC("e1000_get_cable_length_82577");
4034
4035 ret_val = phy->ops.read_reg(hw, I82577_PHY_DIAG_STATUS, &phy_data);
4036 if (ret_val)
4037 return ret_val;
4038
4039 length = ((phy_data & I82577_DSTATUS_CABLE_LENGTH) >>
4040 I82577_DSTATUS_CABLE_LENGTH_SHIFT);
4041
4042 if (length == E1000_CABLE_LENGTH_UNDEFINED)
4043 return -E1000_ERR_PHY;
4044
4045 phy->cable_length = length;
4046
4047 return E1000_SUCCESS;
4048 }
4049
4050 /**
4051 * e1000_write_phy_reg_gs40g - Write GS40G PHY register
4052 * @hw: pointer to the HW structure
4053 * @offset: register offset to write to
4054 * @data: data to write at register offset
4055 *
4056 * Acquires semaphore, if necessary, then writes the data to PHY register
4057 * at the offset. Release any acquired semaphores before exiting.
4058 **/
4059 s32 e1000_write_phy_reg_gs40g(struct e1000_hw *hw, u32 offset, u16 data)
4060 {
4061 s32 ret_val;
4062 u16 page = offset >> GS40G_PAGE_SHIFT;
4063
4064 DEBUGFUNC("e1000_write_phy_reg_gs40g");
4065
4066 offset = offset & GS40G_OFFSET_MASK;
4067 ret_val = hw->phy.ops.acquire(hw);
4068 if (ret_val)
4069 return ret_val;
4070
4071 ret_val = e1000_write_phy_reg_mdic(hw, GS40G_PAGE_SELECT, page);
4072 if (ret_val)
4073 goto release;
4074 ret_val = e1000_write_phy_reg_mdic(hw, offset, data);
4075
4076 release:
4077 hw->phy.ops.release(hw);
4078 return ret_val;
4079 }
4080
4081 /**
4082 * e1000_read_phy_reg_gs40g - Read GS40G PHY register
4083 * @hw: pointer to the HW structure
4084 * @offset: lower half is register offset to read to
4085 * upper half is page to use.
4086 * @data: data to read at register offset
4087 *
4088 * Acquires semaphore, if necessary, then reads the data in the PHY register
4089 * at the offset. Release any acquired semaphores before exiting.
4090 **/
4091 s32 e1000_read_phy_reg_gs40g(struct e1000_hw *hw, u32 offset, u16 *data)
4092 {
4093 s32 ret_val;
4094 u16 page = offset >> GS40G_PAGE_SHIFT;
4095
4096 DEBUGFUNC("e1000_read_phy_reg_gs40g");
4097
4098 offset = offset & GS40G_OFFSET_MASK;
4099 ret_val = hw->phy.ops.acquire(hw);
4100 if (ret_val)
4101 return ret_val;
4102
4103 ret_val = e1000_write_phy_reg_mdic(hw, GS40G_PAGE_SELECT, page);
4104 if (ret_val)
4105 goto release;
4106 ret_val = e1000_read_phy_reg_mdic(hw, offset, data);
4107
4108 release:
4109 hw->phy.ops.release(hw);
4110 return ret_val;
4111 }
4112
4113 /**
4114 * e1000_read_phy_reg_mphy - Read mPHY control register
4115 * @hw: pointer to the HW structure
4116 * @address: address to be read
4117 * @data: pointer to the read data
4118 *
4119 * Reads the mPHY control register in the PHY at offset and stores the
4120 * information read to data.
4121 **/
4122 s32 e1000_read_phy_reg_mphy(struct e1000_hw *hw, u32 address, u32 *data)
4123 {
4124 u32 mphy_ctrl = 0;
4125 bool locked = false;
4126 bool ready;
4127
4128 DEBUGFUNC("e1000_read_phy_reg_mphy");
4129
4130 /* Check if mPHY is ready to read/write operations */
4131 ready = e1000_is_mphy_ready(hw);
4132 if (!ready)
4133 return -E1000_ERR_PHY;
4134
4135 /* Check if mPHY access is disabled and enable it if so */
4136 mphy_ctrl = E1000_READ_REG(hw, E1000_MPHY_ADDR_CTRL);
4137 if (mphy_ctrl & E1000_MPHY_DIS_ACCESS) {
4138 locked = true;
4139 ready = e1000_is_mphy_ready(hw);
4140 if (!ready)
4141 return -E1000_ERR_PHY;
4142 mphy_ctrl |= E1000_MPHY_ENA_ACCESS;
4143 E1000_WRITE_REG(hw, E1000_MPHY_ADDR_CTRL, mphy_ctrl);
4144 }
4145
4146 /* Set the address that we want to read */
4147 ready = e1000_is_mphy_ready(hw);
4148 if (!ready)
4149 return -E1000_ERR_PHY;
4150
4151 /* We mask address, because we want to use only current lane */
4152 mphy_ctrl = (mphy_ctrl & ~E1000_MPHY_ADDRESS_MASK &
4153 ~E1000_MPHY_ADDRESS_FNC_OVERRIDE) |
4154 (address & E1000_MPHY_ADDRESS_MASK);
4155 E1000_WRITE_REG(hw, E1000_MPHY_ADDR_CTRL, mphy_ctrl);
4156
4157 /* Read data from the address */
4158 ready = e1000_is_mphy_ready(hw);
4159 if (!ready)
4160 return -E1000_ERR_PHY;
4161 *data = E1000_READ_REG(hw, E1000_MPHY_DATA);
4162
4163 /* Disable access to mPHY if it was originally disabled */
4164 if (locked)
4165 ready = e1000_is_mphy_ready(hw);
4166 if (!ready)
4167 return -E1000_ERR_PHY;
4168 E1000_WRITE_REG(hw, E1000_MPHY_ADDR_CTRL,
4169 E1000_MPHY_DIS_ACCESS);
4170
4171 return E1000_SUCCESS;
4172 }
4173
4174 /**
4175 * e1000_write_phy_reg_mphy - Write mPHY control register
4176 * @hw: pointer to the HW structure
4177 * @address: address to write to
4178 * @data: data to write to register at offset
4179 * @line_override: used when we want to use different line than default one
4180 *
4181 * Writes data to mPHY control register.
4182 **/
4183 s32 e1000_write_phy_reg_mphy(struct e1000_hw *hw, u32 address, u32 data,
4184 bool line_override)
4185 {
4186 u32 mphy_ctrl = 0;
4187 bool locked = false;
4188 bool ready;
4189
4190 DEBUGFUNC("e1000_write_phy_reg_mphy");
4191
4192 /* Check if mPHY is ready to read/write operations */
4193 ready = e1000_is_mphy_ready(hw);
4194 if (!ready)
4195 return -E1000_ERR_PHY;
4196
4197 /* Check if mPHY access is disabled and enable it if so */
4198 mphy_ctrl = E1000_READ_REG(hw, E1000_MPHY_ADDR_CTRL);
4199 if (mphy_ctrl & E1000_MPHY_DIS_ACCESS) {
4200 locked = true;
4201 ready = e1000_is_mphy_ready(hw);
4202 if (!ready)
4203 return -E1000_ERR_PHY;
4204 mphy_ctrl |= E1000_MPHY_ENA_ACCESS;
4205 E1000_WRITE_REG(hw, E1000_MPHY_ADDR_CTRL, mphy_ctrl);
4206 }
4207
4208 /* Set the address that we want to read */
4209 ready = e1000_is_mphy_ready(hw);
4210 if (!ready)
4211 return -E1000_ERR_PHY;
4212
4213 /* We mask address, because we want to use only current lane */
4214 if (line_override)
4215 mphy_ctrl |= E1000_MPHY_ADDRESS_FNC_OVERRIDE;
4216 else
4217 mphy_ctrl &= ~E1000_MPHY_ADDRESS_FNC_OVERRIDE;
4218 mphy_ctrl = (mphy_ctrl & ~E1000_MPHY_ADDRESS_MASK) |
4219 (address & E1000_MPHY_ADDRESS_MASK);
4220 E1000_WRITE_REG(hw, E1000_MPHY_ADDR_CTRL, mphy_ctrl);
4221
4222 /* Read data from the address */
4223 ready = e1000_is_mphy_ready(hw);
4224 if (!ready)
4225 return -E1000_ERR_PHY;
4226 E1000_WRITE_REG(hw, E1000_MPHY_DATA, data);
4227
4228 /* Disable access to mPHY if it was originally disabled */
4229 if (locked)
4230 ready = e1000_is_mphy_ready(hw);
4231 if (!ready)
4232 return -E1000_ERR_PHY;
4233 E1000_WRITE_REG(hw, E1000_MPHY_ADDR_CTRL,
4234 E1000_MPHY_DIS_ACCESS);
4235
4236 return E1000_SUCCESS;
4237 }
4238
4239 /**
4240 * e1000_is_mphy_ready - Check if mPHY control register is not busy
4241 * @hw: pointer to the HW structure
4242 *
4243 * Returns mPHY control register status.
4244 **/
4245 bool e1000_is_mphy_ready(struct e1000_hw *hw)
4246 {
4247 u16 retry_count = 0;
4248 u32 mphy_ctrl = 0;
4249 bool ready = false;
4250
4251 while (retry_count < 2) {
4252 mphy_ctrl = E1000_READ_REG(hw, E1000_MPHY_ADDR_CTRL);
4253 if (mphy_ctrl & E1000_MPHY_BUSY) {
4254 usec_delay(20);
4255 retry_count++;
4256 continue;
4257 }
4258 ready = true;
4259 break;
4260 }
4261
4262 if (!ready)
4263 DEBUGOUT("ERROR READING mPHY control register, phy is busy.\n");
4264
4265 return ready;
4266 }
4267
4268 /**
4269 * __e1000_access_xmdio_reg - Read/write XMDIO register
4270 * @hw: pointer to the HW structure
4271 * @address: XMDIO address to program
4272 * @dev_addr: device address to program
4273 * @data: pointer to value to read/write from/to the XMDIO address
4274 * @read: boolean flag to indicate read or write
4275 **/
4276 static s32 __e1000_access_xmdio_reg(struct e1000_hw *hw, u16 address,
4277 u8 dev_addr, u16 *data, bool read)
4278 {
4279 s32 ret_val;
4280
4281 DEBUGFUNC("__e1000_access_xmdio_reg");
4282
4283 ret_val = hw->phy.ops.write_reg(hw, E1000_MMDAC, dev_addr);
4284 if (ret_val)
4285 return ret_val;
4286
4287 ret_val = hw->phy.ops.write_reg(hw, E1000_MMDAAD, address);
4288 if (ret_val)
4289 return ret_val;
4290
4291 ret_val = hw->phy.ops.write_reg(hw, E1000_MMDAC, E1000_MMDAC_FUNC_DATA |
4292 dev_addr);
4293 if (ret_val)
4294 return ret_val;
4295
4296 if (read)
4297 ret_val = hw->phy.ops.read_reg(hw, E1000_MMDAAD, data);
4298 else
4299 ret_val = hw->phy.ops.write_reg(hw, E1000_MMDAAD, *data);
4300 if (ret_val)
4301 return ret_val;
4302
4303 /* Recalibrate the device back to 0 */
4304 ret_val = hw->phy.ops.write_reg(hw, E1000_MMDAC, 0);
4305 if (ret_val)
4306 return ret_val;
4307
4308 return ret_val;
4309 }
4310
4311 /**
4312 * e1000_read_xmdio_reg - Read XMDIO register
4313 * @hw: pointer to the HW structure
4314 * @addr: XMDIO address to program
4315 * @dev_addr: device address to program
4316 * @data: value to be read from the EMI address
4317 **/
4318 s32 e1000_read_xmdio_reg(struct e1000_hw *hw, u16 addr, u8 dev_addr, u16 *data)
4319 {
4320 DEBUGFUNC("e1000_read_xmdio_reg");
4321
4322 return __e1000_access_xmdio_reg(hw, addr, dev_addr, data, true);
4323 }
4324
4325 /**
4326 * e1000_write_xmdio_reg - Write XMDIO register
4327 * @hw: pointer to the HW structure
4328 * @addr: XMDIO address to program
4329 * @dev_addr: device address to program
4330 * @data: value to be written to the XMDIO address
4331 **/
4332 s32 e1000_write_xmdio_reg(struct e1000_hw *hw, u16 addr, u8 dev_addr, u16 data)
4333 {
4334 DEBUGFUNC("e1000_write_xmdio_reg");
4335
4336 return __e1000_access_xmdio_reg(hw, addr, dev_addr, &data,
4337 false);
4338 }
Cache object: ebebe562b1220c0149999c2f68e855b4
|