xref: /linux/drivers/net/ethernet/intel/igb/e1000_i210.c (revision 26fbb4c8c7c3ee9a4c3b4de555a8587b5a19154e)
1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 2007 - 2018 Intel Corporation. */
3 
4 /* e1000_i210
5  * e1000_i211
6  */
7 
8 #include <linux/types.h>
9 #include <linux/if_ether.h>
10 
11 #include "e1000_hw.h"
12 #include "e1000_i210.h"
13 
14 static s32 igb_update_flash_i210(struct e1000_hw *hw);
15 
16 /**
17  * igb_get_hw_semaphore_i210 - Acquire hardware semaphore
18  *  @hw: pointer to the HW structure
19  *
20  *  Acquire the HW semaphore to access the PHY or NVM
21  */
22 static s32 igb_get_hw_semaphore_i210(struct e1000_hw *hw)
23 {
24 	u32 swsm;
25 	s32 timeout = hw->nvm.word_size + 1;
26 	s32 i = 0;
27 
28 	/* Get the SW semaphore */
29 	while (i < timeout) {
30 		swsm = rd32(E1000_SWSM);
31 		if (!(swsm & E1000_SWSM_SMBI))
32 			break;
33 
34 		udelay(50);
35 		i++;
36 	}
37 
38 	if (i == timeout) {
39 		/* In rare circumstances, the SW semaphore may already be held
40 		 * unintentionally. Clear the semaphore once before giving up.
41 		 */
42 		if (hw->dev_spec._82575.clear_semaphore_once) {
43 			hw->dev_spec._82575.clear_semaphore_once = false;
44 			igb_put_hw_semaphore(hw);
45 			for (i = 0; i < timeout; i++) {
46 				swsm = rd32(E1000_SWSM);
47 				if (!(swsm & E1000_SWSM_SMBI))
48 					break;
49 
50 				udelay(50);
51 			}
52 		}
53 
54 		/* If we do not have the semaphore here, we have to give up. */
55 		if (i == timeout) {
56 			hw_dbg("Driver can't access device - SMBI bit is set.\n");
57 			return -E1000_ERR_NVM;
58 		}
59 	}
60 
61 	/* Get the FW semaphore. */
62 	for (i = 0; i < timeout; i++) {
63 		swsm = rd32(E1000_SWSM);
64 		wr32(E1000_SWSM, swsm | E1000_SWSM_SWESMBI);
65 
66 		/* Semaphore acquired if bit latched */
67 		if (rd32(E1000_SWSM) & E1000_SWSM_SWESMBI)
68 			break;
69 
70 		udelay(50);
71 	}
72 
73 	if (i == timeout) {
74 		/* Release semaphores */
75 		igb_put_hw_semaphore(hw);
76 		hw_dbg("Driver can't access the NVM\n");
77 		return -E1000_ERR_NVM;
78 	}
79 
80 	return 0;
81 }
82 
83 /**
84  *  igb_acquire_nvm_i210 - Request for access to EEPROM
85  *  @hw: pointer to the HW structure
86  *
87  *  Acquire the necessary semaphores for exclusive access to the EEPROM.
88  *  Set the EEPROM access request bit and wait for EEPROM access grant bit.
89  *  Return successful if access grant bit set, else clear the request for
90  *  EEPROM access and return -E1000_ERR_NVM (-1).
91  **/
92 static s32 igb_acquire_nvm_i210(struct e1000_hw *hw)
93 {
94 	return igb_acquire_swfw_sync_i210(hw, E1000_SWFW_EEP_SM);
95 }
96 
97 /**
98  *  igb_release_nvm_i210 - Release exclusive access to EEPROM
99  *  @hw: pointer to the HW structure
100  *
101  *  Stop any current commands to the EEPROM and clear the EEPROM request bit,
102  *  then release the semaphores acquired.
103  **/
104 static void igb_release_nvm_i210(struct e1000_hw *hw)
105 {
106 	igb_release_swfw_sync_i210(hw, E1000_SWFW_EEP_SM);
107 }
108 
109 /**
110  *  igb_acquire_swfw_sync_i210 - Acquire SW/FW semaphore
111  *  @hw: pointer to the HW structure
112  *  @mask: specifies which semaphore to acquire
113  *
114  *  Acquire the SW/FW semaphore to access the PHY or NVM.  The mask
115  *  will also specify which port we're acquiring the lock for.
116  **/
117 s32 igb_acquire_swfw_sync_i210(struct e1000_hw *hw, u16 mask)
118 {
119 	u32 swfw_sync;
120 	u32 swmask = mask;
121 	u32 fwmask = mask << 16;
122 	s32 ret_val = 0;
123 	s32 i = 0, timeout = 200; /* FIXME: find real value to use here */
124 
125 	while (i < timeout) {
126 		if (igb_get_hw_semaphore_i210(hw)) {
127 			ret_val = -E1000_ERR_SWFW_SYNC;
128 			goto out;
129 		}
130 
131 		swfw_sync = rd32(E1000_SW_FW_SYNC);
132 		if (!(swfw_sync & (fwmask | swmask)))
133 			break;
134 
135 		/* Firmware currently using resource (fwmask) */
136 		igb_put_hw_semaphore(hw);
137 		mdelay(5);
138 		i++;
139 	}
140 
141 	if (i == timeout) {
142 		hw_dbg("Driver can't access resource, SW_FW_SYNC timeout.\n");
143 		ret_val = -E1000_ERR_SWFW_SYNC;
144 		goto out;
145 	}
146 
147 	swfw_sync |= swmask;
148 	wr32(E1000_SW_FW_SYNC, swfw_sync);
149 
150 	igb_put_hw_semaphore(hw);
151 out:
152 	return ret_val;
153 }
154 
155 /**
156  *  igb_release_swfw_sync_i210 - Release SW/FW semaphore
157  *  @hw: pointer to the HW structure
158  *  @mask: specifies which semaphore to acquire
159  *
160  *  Release the SW/FW semaphore used to access the PHY or NVM.  The mask
161  *  will also specify which port we're releasing the lock for.
162  **/
163 void igb_release_swfw_sync_i210(struct e1000_hw *hw, u16 mask)
164 {
165 	u32 swfw_sync;
166 
167 	while (igb_get_hw_semaphore_i210(hw))
168 		; /* Empty */
169 
170 	swfw_sync = rd32(E1000_SW_FW_SYNC);
171 	swfw_sync &= ~mask;
172 	wr32(E1000_SW_FW_SYNC, swfw_sync);
173 
174 	igb_put_hw_semaphore(hw);
175 }
176 
177 /**
178  *  igb_read_nvm_srrd_i210 - Reads Shadow Ram using EERD register
179  *  @hw: pointer to the HW structure
180  *  @offset: offset of word in the Shadow Ram to read
181  *  @words: number of words to read
182  *  @data: word read from the Shadow Ram
183  *
184  *  Reads a 16 bit word from the Shadow Ram using the EERD register.
185  *  Uses necessary synchronization semaphores.
186  **/
187 static s32 igb_read_nvm_srrd_i210(struct e1000_hw *hw, u16 offset, u16 words,
188 				  u16 *data)
189 {
190 	s32 status = 0;
191 	u16 i, count;
192 
193 	/* We cannot hold synchronization semaphores for too long,
194 	 * because of forceful takeover procedure. However it is more efficient
195 	 * to read in bursts than synchronizing access for each word.
196 	 */
197 	for (i = 0; i < words; i += E1000_EERD_EEWR_MAX_COUNT) {
198 		count = (words - i) / E1000_EERD_EEWR_MAX_COUNT > 0 ?
199 			E1000_EERD_EEWR_MAX_COUNT : (words - i);
200 		if (!(hw->nvm.ops.acquire(hw))) {
201 			status = igb_read_nvm_eerd(hw, offset, count,
202 						     data + i);
203 			hw->nvm.ops.release(hw);
204 		} else {
205 			status = E1000_ERR_SWFW_SYNC;
206 		}
207 
208 		if (status)
209 			break;
210 	}
211 
212 	return status;
213 }
214 
215 /**
216  *  igb_write_nvm_srwr - Write to Shadow Ram using EEWR
217  *  @hw: pointer to the HW structure
218  *  @offset: offset within the Shadow Ram to be written to
219  *  @words: number of words to write
220  *  @data: 16 bit word(s) to be written to the Shadow Ram
221  *
222  *  Writes data to Shadow Ram at offset using EEWR register.
223  *
224  *  If igb_update_nvm_checksum is not called after this function , the
225  *  Shadow Ram will most likely contain an invalid checksum.
226  **/
227 static s32 igb_write_nvm_srwr(struct e1000_hw *hw, u16 offset, u16 words,
228 				u16 *data)
229 {
230 	struct e1000_nvm_info *nvm = &hw->nvm;
231 	u32 i, k, eewr = 0;
232 	u32 attempts = 100000;
233 	s32 ret_val = 0;
234 
235 	/* A check for invalid values:  offset too large, too many words,
236 	 * too many words for the offset, and not enough words.
237 	 */
238 	if ((offset >= nvm->word_size) || (words > (nvm->word_size - offset)) ||
239 	    (words == 0)) {
240 		hw_dbg("nvm parameter(s) out of bounds\n");
241 		ret_val = -E1000_ERR_NVM;
242 		goto out;
243 	}
244 
245 	for (i = 0; i < words; i++) {
246 		eewr = ((offset+i) << E1000_NVM_RW_ADDR_SHIFT) |
247 			(data[i] << E1000_NVM_RW_REG_DATA) |
248 			E1000_NVM_RW_REG_START;
249 
250 		wr32(E1000_SRWR, eewr);
251 
252 		for (k = 0; k < attempts; k++) {
253 			if (E1000_NVM_RW_REG_DONE &
254 			    rd32(E1000_SRWR)) {
255 				ret_val = 0;
256 				break;
257 			}
258 			udelay(5);
259 	}
260 
261 		if (ret_val) {
262 			hw_dbg("Shadow RAM write EEWR timed out\n");
263 			break;
264 		}
265 	}
266 
267 out:
268 	return ret_val;
269 }
270 
271 /**
272  *  igb_write_nvm_srwr_i210 - Write to Shadow RAM using EEWR
273  *  @hw: pointer to the HW structure
274  *  @offset: offset within the Shadow RAM to be written to
275  *  @words: number of words to write
276  *  @data: 16 bit word(s) to be written to the Shadow RAM
277  *
278  *  Writes data to Shadow RAM at offset using EEWR register.
279  *
280  *  If e1000_update_nvm_checksum is not called after this function , the
281  *  data will not be committed to FLASH and also Shadow RAM will most likely
282  *  contain an invalid checksum.
283  *
284  *  If error code is returned, data and Shadow RAM may be inconsistent - buffer
285  *  partially written.
286  **/
287 static s32 igb_write_nvm_srwr_i210(struct e1000_hw *hw, u16 offset, u16 words,
288 				   u16 *data)
289 {
290 	s32 status = 0;
291 	u16 i, count;
292 
293 	/* We cannot hold synchronization semaphores for too long,
294 	 * because of forceful takeover procedure. However it is more efficient
295 	 * to write in bursts than synchronizing access for each word.
296 	 */
297 	for (i = 0; i < words; i += E1000_EERD_EEWR_MAX_COUNT) {
298 		count = (words - i) / E1000_EERD_EEWR_MAX_COUNT > 0 ?
299 			E1000_EERD_EEWR_MAX_COUNT : (words - i);
300 		if (!(hw->nvm.ops.acquire(hw))) {
301 			status = igb_write_nvm_srwr(hw, offset, count,
302 						      data + i);
303 			hw->nvm.ops.release(hw);
304 		} else {
305 			status = E1000_ERR_SWFW_SYNC;
306 		}
307 
308 		if (status)
309 			break;
310 	}
311 
312 	return status;
313 }
314 
315 /**
316  *  igb_read_invm_word_i210 - Reads OTP
317  *  @hw: pointer to the HW structure
318  *  @address: the word address (aka eeprom offset) to read
319  *  @data: pointer to the data read
320  *
321  *  Reads 16-bit words from the OTP. Return error when the word is not
322  *  stored in OTP.
323  **/
324 static s32 igb_read_invm_word_i210(struct e1000_hw *hw, u8 address, u16 *data)
325 {
326 	s32 status = -E1000_ERR_INVM_VALUE_NOT_FOUND;
327 	u32 invm_dword;
328 	u16 i;
329 	u8 record_type, word_address;
330 
331 	for (i = 0; i < E1000_INVM_SIZE; i++) {
332 		invm_dword = rd32(E1000_INVM_DATA_REG(i));
333 		/* Get record type */
334 		record_type = INVM_DWORD_TO_RECORD_TYPE(invm_dword);
335 		if (record_type == E1000_INVM_UNINITIALIZED_STRUCTURE)
336 			break;
337 		if (record_type == E1000_INVM_CSR_AUTOLOAD_STRUCTURE)
338 			i += E1000_INVM_CSR_AUTOLOAD_DATA_SIZE_IN_DWORDS;
339 		if (record_type == E1000_INVM_RSA_KEY_SHA256_STRUCTURE)
340 			i += E1000_INVM_RSA_KEY_SHA256_DATA_SIZE_IN_DWORDS;
341 		if (record_type == E1000_INVM_WORD_AUTOLOAD_STRUCTURE) {
342 			word_address = INVM_DWORD_TO_WORD_ADDRESS(invm_dword);
343 			if (word_address == address) {
344 				*data = INVM_DWORD_TO_WORD_DATA(invm_dword);
345 				hw_dbg("Read INVM Word 0x%02x = %x\n",
346 					  address, *data);
347 				status = 0;
348 				break;
349 			}
350 		}
351 	}
352 	if (status)
353 		hw_dbg("Requested word 0x%02x not found in OTP\n", address);
354 	return status;
355 }
356 
357 /**
358  * igb_read_invm_i210 - Read invm wrapper function for I210/I211
359  *  @hw: pointer to the HW structure
360  *  @offset: offset to read from
361  *  @words: number of words to read (unused)
362  *  @data: pointer to the data read
363  *
364  *  Wrapper function to return data formerly found in the NVM.
365  **/
366 static s32 igb_read_invm_i210(struct e1000_hw *hw, u16 offset,
367 				u16 __always_unused words, u16 *data)
368 {
369 	s32 ret_val = 0;
370 
371 	/* Only the MAC addr is required to be present in the iNVM */
372 	switch (offset) {
373 	case NVM_MAC_ADDR:
374 		ret_val = igb_read_invm_word_i210(hw, (u8)offset, &data[0]);
375 		ret_val |= igb_read_invm_word_i210(hw, (u8)offset+1,
376 						     &data[1]);
377 		ret_val |= igb_read_invm_word_i210(hw, (u8)offset+2,
378 						     &data[2]);
379 		if (ret_val)
380 			hw_dbg("MAC Addr not found in iNVM\n");
381 		break;
382 	case NVM_INIT_CTRL_2:
383 		ret_val = igb_read_invm_word_i210(hw, (u8)offset, data);
384 		if (ret_val) {
385 			*data = NVM_INIT_CTRL_2_DEFAULT_I211;
386 			ret_val = 0;
387 		}
388 		break;
389 	case NVM_INIT_CTRL_4:
390 		ret_val = igb_read_invm_word_i210(hw, (u8)offset, data);
391 		if (ret_val) {
392 			*data = NVM_INIT_CTRL_4_DEFAULT_I211;
393 			ret_val = 0;
394 		}
395 		break;
396 	case NVM_LED_1_CFG:
397 		ret_val = igb_read_invm_word_i210(hw, (u8)offset, data);
398 		if (ret_val) {
399 			*data = NVM_LED_1_CFG_DEFAULT_I211;
400 			ret_val = 0;
401 		}
402 		break;
403 	case NVM_LED_0_2_CFG:
404 		ret_val = igb_read_invm_word_i210(hw, (u8)offset, data);
405 		if (ret_val) {
406 			*data = NVM_LED_0_2_CFG_DEFAULT_I211;
407 			ret_val = 0;
408 		}
409 		break;
410 	case NVM_ID_LED_SETTINGS:
411 		ret_val = igb_read_invm_word_i210(hw, (u8)offset, data);
412 		if (ret_val) {
413 			*data = ID_LED_RESERVED_FFFF;
414 			ret_val = 0;
415 		}
416 		break;
417 	case NVM_SUB_DEV_ID:
418 		*data = hw->subsystem_device_id;
419 		break;
420 	case NVM_SUB_VEN_ID:
421 		*data = hw->subsystem_vendor_id;
422 		break;
423 	case NVM_DEV_ID:
424 		*data = hw->device_id;
425 		break;
426 	case NVM_VEN_ID:
427 		*data = hw->vendor_id;
428 		break;
429 	default:
430 		hw_dbg("NVM word 0x%02x is not mapped.\n", offset);
431 		*data = NVM_RESERVED_WORD;
432 		break;
433 	}
434 	return ret_val;
435 }
436 
437 /**
438  *  igb_read_invm_version - Reads iNVM version and image type
439  *  @hw: pointer to the HW structure
440  *  @invm_ver: version structure for the version read
441  *
442  *  Reads iNVM version and image type.
443  **/
444 s32 igb_read_invm_version(struct e1000_hw *hw,
445 			  struct e1000_fw_version *invm_ver) {
446 	u32 *record = NULL;
447 	u32 *next_record = NULL;
448 	u32 i = 0;
449 	u32 invm_dword = 0;
450 	u32 invm_blocks = E1000_INVM_SIZE - (E1000_INVM_ULT_BYTES_SIZE /
451 					     E1000_INVM_RECORD_SIZE_IN_BYTES);
452 	u32 buffer[E1000_INVM_SIZE];
453 	s32 status = -E1000_ERR_INVM_VALUE_NOT_FOUND;
454 	u16 version = 0;
455 
456 	/* Read iNVM memory */
457 	for (i = 0; i < E1000_INVM_SIZE; i++) {
458 		invm_dword = rd32(E1000_INVM_DATA_REG(i));
459 		buffer[i] = invm_dword;
460 	}
461 
462 	/* Read version number */
463 	for (i = 1; i < invm_blocks; i++) {
464 		record = &buffer[invm_blocks - i];
465 		next_record = &buffer[invm_blocks - i + 1];
466 
467 		/* Check if we have first version location used */
468 		if ((i == 1) && ((*record & E1000_INVM_VER_FIELD_ONE) == 0)) {
469 			version = 0;
470 			status = 0;
471 			break;
472 		}
473 		/* Check if we have second version location used */
474 		else if ((i == 1) &&
475 			 ((*record & E1000_INVM_VER_FIELD_TWO) == 0)) {
476 			version = (*record & E1000_INVM_VER_FIELD_ONE) >> 3;
477 			status = 0;
478 			break;
479 		}
480 		/* Check if we have odd version location
481 		 * used and it is the last one used
482 		 */
483 		else if ((((*record & E1000_INVM_VER_FIELD_ONE) == 0) &&
484 			 ((*record & 0x3) == 0)) || (((*record & 0x3) != 0) &&
485 			 (i != 1))) {
486 			version = (*next_record & E1000_INVM_VER_FIELD_TWO)
487 				  >> 13;
488 			status = 0;
489 			break;
490 		}
491 		/* Check if we have even version location
492 		 * used and it is the last one used
493 		 */
494 		else if (((*record & E1000_INVM_VER_FIELD_TWO) == 0) &&
495 			 ((*record & 0x3) == 0)) {
496 			version = (*record & E1000_INVM_VER_FIELD_ONE) >> 3;
497 			status = 0;
498 			break;
499 		}
500 	}
501 
502 	if (!status) {
503 		invm_ver->invm_major = (version & E1000_INVM_MAJOR_MASK)
504 					>> E1000_INVM_MAJOR_SHIFT;
505 		invm_ver->invm_minor = version & E1000_INVM_MINOR_MASK;
506 	}
507 	/* Read Image Type */
508 	for (i = 1; i < invm_blocks; i++) {
509 		record = &buffer[invm_blocks - i];
510 		next_record = &buffer[invm_blocks - i + 1];
511 
512 		/* Check if we have image type in first location used */
513 		if ((i == 1) && ((*record & E1000_INVM_IMGTYPE_FIELD) == 0)) {
514 			invm_ver->invm_img_type = 0;
515 			status = 0;
516 			break;
517 		}
518 		/* Check if we have image type in first location used */
519 		else if ((((*record & 0x3) == 0) &&
520 			 ((*record & E1000_INVM_IMGTYPE_FIELD) == 0)) ||
521 			 ((((*record & 0x3) != 0) && (i != 1)))) {
522 			invm_ver->invm_img_type =
523 				(*next_record & E1000_INVM_IMGTYPE_FIELD) >> 23;
524 			status = 0;
525 			break;
526 		}
527 	}
528 	return status;
529 }
530 
531 /**
532  *  igb_validate_nvm_checksum_i210 - Validate EEPROM checksum
533  *  @hw: pointer to the HW structure
534  *
535  *  Calculates the EEPROM checksum by reading/adding each word of the EEPROM
536  *  and then verifies that the sum of the EEPROM is equal to 0xBABA.
537  **/
538 static s32 igb_validate_nvm_checksum_i210(struct e1000_hw *hw)
539 {
540 	s32 status = 0;
541 	s32 (*read_op_ptr)(struct e1000_hw *, u16, u16, u16 *);
542 
543 	if (!(hw->nvm.ops.acquire(hw))) {
544 
545 		/* Replace the read function with semaphore grabbing with
546 		 * the one that skips this for a while.
547 		 * We have semaphore taken already here.
548 		 */
549 		read_op_ptr = hw->nvm.ops.read;
550 		hw->nvm.ops.read = igb_read_nvm_eerd;
551 
552 		status = igb_validate_nvm_checksum(hw);
553 
554 		/* Revert original read operation. */
555 		hw->nvm.ops.read = read_op_ptr;
556 
557 		hw->nvm.ops.release(hw);
558 	} else {
559 		status = E1000_ERR_SWFW_SYNC;
560 	}
561 
562 	return status;
563 }
564 
565 /**
566  *  igb_update_nvm_checksum_i210 - Update EEPROM checksum
567  *  @hw: pointer to the HW structure
568  *
569  *  Updates the EEPROM checksum by reading/adding each word of the EEPROM
570  *  up to the checksum.  Then calculates the EEPROM checksum and writes the
571  *  value to the EEPROM. Next commit EEPROM data onto the Flash.
572  **/
573 static s32 igb_update_nvm_checksum_i210(struct e1000_hw *hw)
574 {
575 	s32 ret_val = 0;
576 	u16 checksum = 0;
577 	u16 i, nvm_data;
578 
579 	/* Read the first word from the EEPROM. If this times out or fails, do
580 	 * not continue or we could be in for a very long wait while every
581 	 * EEPROM read fails
582 	 */
583 	ret_val = igb_read_nvm_eerd(hw, 0, 1, &nvm_data);
584 	if (ret_val) {
585 		hw_dbg("EEPROM read failed\n");
586 		goto out;
587 	}
588 
589 	if (!(hw->nvm.ops.acquire(hw))) {
590 		/* Do not use hw->nvm.ops.write, hw->nvm.ops.read
591 		 * because we do not want to take the synchronization
592 		 * semaphores twice here.
593 		 */
594 
595 		for (i = 0; i < NVM_CHECKSUM_REG; i++) {
596 			ret_val = igb_read_nvm_eerd(hw, i, 1, &nvm_data);
597 			if (ret_val) {
598 				hw->nvm.ops.release(hw);
599 				hw_dbg("NVM Read Error while updating checksum.\n");
600 				goto out;
601 			}
602 			checksum += nvm_data;
603 		}
604 		checksum = (u16) NVM_SUM - checksum;
605 		ret_val = igb_write_nvm_srwr(hw, NVM_CHECKSUM_REG, 1,
606 						&checksum);
607 		if (ret_val) {
608 			hw->nvm.ops.release(hw);
609 			hw_dbg("NVM Write Error while updating checksum.\n");
610 			goto out;
611 		}
612 
613 		hw->nvm.ops.release(hw);
614 
615 		ret_val = igb_update_flash_i210(hw);
616 	} else {
617 		ret_val = -E1000_ERR_SWFW_SYNC;
618 	}
619 out:
620 	return ret_val;
621 }
622 
623 /**
624  *  igb_pool_flash_update_done_i210 - Pool FLUDONE status.
625  *  @hw: pointer to the HW structure
626  *
627  **/
628 static s32 igb_pool_flash_update_done_i210(struct e1000_hw *hw)
629 {
630 	s32 ret_val = -E1000_ERR_NVM;
631 	u32 i, reg;
632 
633 	for (i = 0; i < E1000_FLUDONE_ATTEMPTS; i++) {
634 		reg = rd32(E1000_EECD);
635 		if (reg & E1000_EECD_FLUDONE_I210) {
636 			ret_val = 0;
637 			break;
638 		}
639 		udelay(5);
640 	}
641 
642 	return ret_val;
643 }
644 
645 /**
646  *  igb_get_flash_presence_i210 - Check if flash device is detected.
647  *  @hw: pointer to the HW structure
648  *
649  **/
650 bool igb_get_flash_presence_i210(struct e1000_hw *hw)
651 {
652 	u32 eec = 0;
653 	bool ret_val = false;
654 
655 	eec = rd32(E1000_EECD);
656 	if (eec & E1000_EECD_FLASH_DETECTED_I210)
657 		ret_val = true;
658 
659 	return ret_val;
660 }
661 
662 /**
663  *  igb_update_flash_i210 - Commit EEPROM to the flash
664  *  @hw: pointer to the HW structure
665  *
666  **/
667 static s32 igb_update_flash_i210(struct e1000_hw *hw)
668 {
669 	s32 ret_val = 0;
670 	u32 flup;
671 
672 	ret_val = igb_pool_flash_update_done_i210(hw);
673 	if (ret_val == -E1000_ERR_NVM) {
674 		hw_dbg("Flash update time out\n");
675 		goto out;
676 	}
677 
678 	flup = rd32(E1000_EECD) | E1000_EECD_FLUPD_I210;
679 	wr32(E1000_EECD, flup);
680 
681 	ret_val = igb_pool_flash_update_done_i210(hw);
682 	if (ret_val)
683 		hw_dbg("Flash update time out\n");
684 	else
685 		hw_dbg("Flash update complete\n");
686 
687 out:
688 	return ret_val;
689 }
690 
691 /**
692  *  igb_valid_led_default_i210 - Verify a valid default LED config
693  *  @hw: pointer to the HW structure
694  *  @data: pointer to the NVM (EEPROM)
695  *
696  *  Read the EEPROM for the current default LED configuration.  If the
697  *  LED configuration is not valid, set to a valid LED configuration.
698  **/
699 s32 igb_valid_led_default_i210(struct e1000_hw *hw, u16 *data)
700 {
701 	s32 ret_val;
702 
703 	ret_val = hw->nvm.ops.read(hw, NVM_ID_LED_SETTINGS, 1, data);
704 	if (ret_val) {
705 		hw_dbg("NVM Read Error\n");
706 		goto out;
707 	}
708 
709 	if (*data == ID_LED_RESERVED_0000 || *data == ID_LED_RESERVED_FFFF) {
710 		switch (hw->phy.media_type) {
711 		case e1000_media_type_internal_serdes:
712 			*data = ID_LED_DEFAULT_I210_SERDES;
713 			break;
714 		case e1000_media_type_copper:
715 		default:
716 			*data = ID_LED_DEFAULT_I210;
717 			break;
718 		}
719 	}
720 out:
721 	return ret_val;
722 }
723 
724 /**
725  *  __igb_access_xmdio_reg - Read/write XMDIO register
726  *  @hw: pointer to the HW structure
727  *  @address: XMDIO address to program
728  *  @dev_addr: device address to program
729  *  @data: pointer to value to read/write from/to the XMDIO address
730  *  @read: boolean flag to indicate read or write
731  **/
732 static s32 __igb_access_xmdio_reg(struct e1000_hw *hw, u16 address,
733 				  u8 dev_addr, u16 *data, bool read)
734 {
735 	s32 ret_val = 0;
736 
737 	ret_val = hw->phy.ops.write_reg(hw, E1000_MMDAC, dev_addr);
738 	if (ret_val)
739 		return ret_val;
740 
741 	ret_val = hw->phy.ops.write_reg(hw, E1000_MMDAAD, address);
742 	if (ret_val)
743 		return ret_val;
744 
745 	ret_val = hw->phy.ops.write_reg(hw, E1000_MMDAC, E1000_MMDAC_FUNC_DATA |
746 							 dev_addr);
747 	if (ret_val)
748 		return ret_val;
749 
750 	if (read)
751 		ret_val = hw->phy.ops.read_reg(hw, E1000_MMDAAD, data);
752 	else
753 		ret_val = hw->phy.ops.write_reg(hw, E1000_MMDAAD, *data);
754 	if (ret_val)
755 		return ret_val;
756 
757 	/* Recalibrate the device back to 0 */
758 	ret_val = hw->phy.ops.write_reg(hw, E1000_MMDAC, 0);
759 	if (ret_val)
760 		return ret_val;
761 
762 	return ret_val;
763 }
764 
765 /**
766  *  igb_read_xmdio_reg - Read XMDIO register
767  *  @hw: pointer to the HW structure
768  *  @addr: XMDIO address to program
769  *  @dev_addr: device address to program
770  *  @data: value to be read from the EMI address
771  **/
772 s32 igb_read_xmdio_reg(struct e1000_hw *hw, u16 addr, u8 dev_addr, u16 *data)
773 {
774 	return __igb_access_xmdio_reg(hw, addr, dev_addr, data, true);
775 }
776 
777 /**
778  *  igb_write_xmdio_reg - Write XMDIO register
779  *  @hw: pointer to the HW structure
780  *  @addr: XMDIO address to program
781  *  @dev_addr: device address to program
782  *  @data: value to be written to the XMDIO address
783  **/
784 s32 igb_write_xmdio_reg(struct e1000_hw *hw, u16 addr, u8 dev_addr, u16 data)
785 {
786 	return __igb_access_xmdio_reg(hw, addr, dev_addr, &data, false);
787 }
788 
789 /**
790  *  igb_init_nvm_params_i210 - Init NVM func ptrs.
791  *  @hw: pointer to the HW structure
792  **/
793 s32 igb_init_nvm_params_i210(struct e1000_hw *hw)
794 {
795 	s32 ret_val = 0;
796 	struct e1000_nvm_info *nvm = &hw->nvm;
797 
798 	nvm->ops.acquire = igb_acquire_nvm_i210;
799 	nvm->ops.release = igb_release_nvm_i210;
800 	nvm->ops.valid_led_default = igb_valid_led_default_i210;
801 
802 	/* NVM Function Pointers */
803 	if (igb_get_flash_presence_i210(hw)) {
804 		hw->nvm.type = e1000_nvm_flash_hw;
805 		nvm->ops.read    = igb_read_nvm_srrd_i210;
806 		nvm->ops.write   = igb_write_nvm_srwr_i210;
807 		nvm->ops.validate = igb_validate_nvm_checksum_i210;
808 		nvm->ops.update   = igb_update_nvm_checksum_i210;
809 	} else {
810 		hw->nvm.type = e1000_nvm_invm;
811 		nvm->ops.read     = igb_read_invm_i210;
812 		nvm->ops.write    = NULL;
813 		nvm->ops.validate = NULL;
814 		nvm->ops.update   = NULL;
815 	}
816 	return ret_val;
817 }
818 
819 /**
820  * igb_pll_workaround_i210
821  * @hw: pointer to the HW structure
822  *
823  * Works around an errata in the PLL circuit where it occasionally
824  * provides the wrong clock frequency after power up.
825  **/
826 s32 igb_pll_workaround_i210(struct e1000_hw *hw)
827 {
828 	s32 ret_val;
829 	u32 wuc, mdicnfg, ctrl, ctrl_ext, reg_val;
830 	u16 nvm_word, phy_word, pci_word, tmp_nvm;
831 	int i;
832 
833 	/* Get and set needed register values */
834 	wuc = rd32(E1000_WUC);
835 	mdicnfg = rd32(E1000_MDICNFG);
836 	reg_val = mdicnfg & ~E1000_MDICNFG_EXT_MDIO;
837 	wr32(E1000_MDICNFG, reg_val);
838 
839 	/* Get data from NVM, or set default */
840 	ret_val = igb_read_invm_word_i210(hw, E1000_INVM_AUTOLOAD,
841 					  &nvm_word);
842 	if (ret_val)
843 		nvm_word = E1000_INVM_DEFAULT_AL;
844 	tmp_nvm = nvm_word | E1000_INVM_PLL_WO_VAL;
845 	igb_write_phy_reg_82580(hw, I347AT4_PAGE_SELECT, E1000_PHY_PLL_FREQ_PAGE);
846 	phy_word = E1000_PHY_PLL_UNCONF;
847 	for (i = 0; i < E1000_MAX_PLL_TRIES; i++) {
848 		/* check current state directly from internal PHY */
849 		igb_read_phy_reg_82580(hw, E1000_PHY_PLL_FREQ_REG, &phy_word);
850 		if ((phy_word & E1000_PHY_PLL_UNCONF)
851 		    != E1000_PHY_PLL_UNCONF) {
852 			ret_val = 0;
853 			break;
854 		} else {
855 			ret_val = -E1000_ERR_PHY;
856 		}
857 		/* directly reset the internal PHY */
858 		ctrl = rd32(E1000_CTRL);
859 		wr32(E1000_CTRL, ctrl|E1000_CTRL_PHY_RST);
860 
861 		ctrl_ext = rd32(E1000_CTRL_EXT);
862 		ctrl_ext |= (E1000_CTRL_EXT_PHYPDEN | E1000_CTRL_EXT_SDLPE);
863 		wr32(E1000_CTRL_EXT, ctrl_ext);
864 
865 		wr32(E1000_WUC, 0);
866 		reg_val = (E1000_INVM_AUTOLOAD << 4) | (tmp_nvm << 16);
867 		wr32(E1000_EEARBC_I210, reg_val);
868 
869 		igb_read_pci_cfg(hw, E1000_PCI_PMCSR, &pci_word);
870 		pci_word |= E1000_PCI_PMCSR_D3;
871 		igb_write_pci_cfg(hw, E1000_PCI_PMCSR, &pci_word);
872 		usleep_range(1000, 2000);
873 		pci_word &= ~E1000_PCI_PMCSR_D3;
874 		igb_write_pci_cfg(hw, E1000_PCI_PMCSR, &pci_word);
875 		reg_val = (E1000_INVM_AUTOLOAD << 4) | (nvm_word << 16);
876 		wr32(E1000_EEARBC_I210, reg_val);
877 
878 		/* restore WUC register */
879 		wr32(E1000_WUC, wuc);
880 	}
881 	igb_write_phy_reg_82580(hw, I347AT4_PAGE_SELECT, 0);
882 	/* restore MDICNFG setting */
883 	wr32(E1000_MDICNFG, mdicnfg);
884 	return ret_val;
885 }
886 
887 /**
888  *  igb_get_cfg_done_i210 - Read config done bit
889  *  @hw: pointer to the HW structure
890  *
891  *  Read the management control register for the config done bit for
892  *  completion status.  NOTE: silicon which is EEPROM-less will fail trying
893  *  to read the config done bit, so an error is *ONLY* logged and returns
894  *  0.  If we were to return with error, EEPROM-less silicon
895  *  would not be able to be reset or change link.
896  **/
897 s32 igb_get_cfg_done_i210(struct e1000_hw *hw)
898 {
899 	s32 timeout = PHY_CFG_TIMEOUT;
900 	u32 mask = E1000_NVM_CFG_DONE_PORT_0;
901 
902 	while (timeout) {
903 		if (rd32(E1000_EEMNGCTL_I210) & mask)
904 			break;
905 		usleep_range(1000, 2000);
906 		timeout--;
907 	}
908 	if (!timeout)
909 		hw_dbg("MNG configuration cycle has not completed.\n");
910 
911 	return 0;
912 }
913