90 lines
		
	
	
		
			2.1 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			90 lines
		
	
	
		
			2.1 KiB
		
	
	
	
		
			C
		
	
	
	
| /*
 | |
|  * (C) Copyright 2000, 2001, 2002
 | |
|  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
 | |
|  *
 | |
|  * SPDX-License-Identifier:	GPL-2.0+
 | |
|  */
 | |
| 
 | |
| #include <common.h>
 | |
| #include <mpc8xx.h>
 | |
| 
 | |
| /*-----------------------------------------------------------------------
 | |
|  * Process Hardware Information Block:
 | |
|  *
 | |
|  * If we boot on a system fresh from factory, check if the Hardware
 | |
|  * Information Block exists and save the information it contains.
 | |
|  *
 | |
|  * The TQM8xxL / TQM82xx Hardware Information Block is defined as
 | |
|  * follows:
 | |
|  * - located in first flash bank
 | |
|  * - starts at offset 0x0003FFC0
 | |
|  * - size 0x00000040
 | |
|  *
 | |
|  * Internal structure:
 | |
|  * - sequence of ASCII character strings
 | |
|  * - fields separated by a single space character (0x20)
 | |
|  * - last field terminated by NUL character (0x00)
 | |
|  * - remaining space filled with NUL characters (0x00)
 | |
|  *
 | |
|  * Fields in Hardware Information Block:
 | |
|  * 1) Module Type
 | |
|  * 2) Serial Number
 | |
|  * 3) First MAC Address
 | |
|  * 4) Number of additional MAC addresses
 | |
|  */
 | |
| 
 | |
| void load_sernum_ethaddr (void)
 | |
| {
 | |
| 	unsigned char *hwi;
 | |
| 	unsigned char  serial [CONFIG_SYS_HWINFO_SIZE];
 | |
| 	unsigned char  ethaddr[CONFIG_SYS_HWINFO_SIZE];
 | |
| 	unsigned short ih, is, ie, part;
 | |
| 
 | |
| 	hwi = (unsigned char *)(CONFIG_SYS_FLASH_BASE + CONFIG_SYS_HWINFO_OFFSET);
 | |
| 	ih = is = ie = 0;
 | |
| 
 | |
| 	if (*((unsigned long *)hwi) != (unsigned long)CONFIG_SYS_HWINFO_MAGIC) {
 | |
| 		return;
 | |
| 	}
 | |
| 
 | |
| 	part = 1;
 | |
| 
 | |
| 	/* copy serial # / MAC address */
 | |
| 	while ((hwi[ih] != '\0') && (ih < CONFIG_SYS_HWINFO_SIZE)) {
 | |
| 		if (hwi[ih] < ' ' || hwi[ih] > '~') { /* ASCII strings! */
 | |
| 			return;
 | |
| 		}
 | |
| 		switch (part) {
 | |
| 		default:		/* Copy serial # */
 | |
| 			if (hwi[ih] == ' ') {
 | |
| 				++part;
 | |
| 			}
 | |
| 			serial[is++] = hwi[ih];
 | |
| 			break;
 | |
| 		case 3:			/* Copy MAC address */
 | |
| 			if (hwi[ih] == ' ') {
 | |
| 				++part;
 | |
| 				break;
 | |
| 			}
 | |
| 			ethaddr[ie++] = hwi[ih];
 | |
| 			if ((ie % 3) == 2)
 | |
| 				ethaddr[ie++] = ':';
 | |
| 			break;
 | |
| 		}
 | |
| 		++ih;
 | |
| 	}
 | |
| 	serial[is]  = '\0';
 | |
| 	if (ie && ethaddr[ie-1] == ':')
 | |
| 		--ie;
 | |
| 	ethaddr[ie] = '\0';
 | |
| 
 | |
| 	/* set serial# and ethaddr if not yet defined */
 | |
| 	if (getenv("serial#") == NULL) {
 | |
| 		setenv ((char *)"serial#", (char *)serial);
 | |
| 	}
 | |
| 
 | |
| 	if (getenv("ethaddr") == NULL) {
 | |
| 		setenv ((char *)"ethaddr", (char *)ethaddr);
 | |
| 	}
 | |
| }
 |