1 /* 2 * This file is subject to the terms and conditions of the GNU General Public 3 * License. See the file "COPYING" in the main directory of this archive 4 * for more details. 5 * 6 * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr> 7 * Copyright (C) 2008 Florian Fainelli <florian@openwrt.org> 8 * Copyright (C) 2012 Jonas Gorski <jonas.gorski@gmail.com> 9 */ 10 11 #define pr_fmt(fmt) "bcm63xx_nvram: " fmt 12 13 #include <linux/init.h> 14 #include <linux/crc32.h> 15 #include <linux/export.h> 16 #include <linux/kernel.h> 17 #include <linux/if_ether.h> 18 19 #include <bcm63xx_nvram.h> 20 21 /* 22 * nvram structure 23 */ 24 struct bcm963xx_nvram { 25 u32 version; 26 u8 reserved1[256]; 27 u8 name[16]; 28 u32 main_tp_number; 29 u32 psi_size; 30 u32 mac_addr_count; 31 u8 mac_addr_base[ETH_ALEN]; 32 u8 reserved2[2]; 33 u32 checksum_old; 34 u8 reserved3[720]; 35 u32 checksum_high; 36 }; 37 38 static struct bcm963xx_nvram nvram; 39 static int mac_addr_used; 40 41 void __init bcm63xx_nvram_init(void *addr) 42 { 43 unsigned int check_len; 44 u32 crc, expected_crc; 45 u8 hcs_mac_addr[ETH_ALEN] = { 0x00, 0x10, 0x18, 0xff, 0xff, 0xff }; 46 47 /* extract nvram data */ 48 memcpy(&nvram, addr, sizeof(nvram)); 49 50 /* check checksum before using data */ 51 if (nvram.version <= 4) { 52 check_len = offsetof(struct bcm963xx_nvram, reserved3); 53 expected_crc = nvram.checksum_old; 54 nvram.checksum_old = 0; 55 } else { 56 check_len = sizeof(nvram); 57 expected_crc = nvram.checksum_high; 58 nvram.checksum_high = 0; 59 } 60 61 crc = crc32_le(~0, (u8 *)&nvram, check_len); 62 63 if (crc != expected_crc) 64 pr_warn("nvram checksum failed, contents may be invalid (expected %08x, got %08x)\n", 65 expected_crc, crc); 66 67 /* Cable modems have a different NVRAM which is embedded in the eCos 68 * firmware and not easily extractible, give at least a MAC address 69 * pool. 70 */ 71 if (BCMCPU_IS_3368()) { 72 memcpy(nvram.mac_addr_base, hcs_mac_addr, ETH_ALEN); 73 nvram.mac_addr_count = 2; 74 } 75 } 76 77 u8 *bcm63xx_nvram_get_name(void) 78 { 79 return nvram.name; 80 } 81 EXPORT_SYMBOL(bcm63xx_nvram_get_name); 82 83 int bcm63xx_nvram_get_mac_address(u8 *mac) 84 { 85 u8 *oui; 86 int count; 87 88 if (mac_addr_used >= nvram.mac_addr_count) { 89 pr_err("not enough mac addresses\n"); 90 return -ENODEV; 91 } 92 93 memcpy(mac, nvram.mac_addr_base, ETH_ALEN); 94 oui = mac + ETH_ALEN/2 - 1; 95 count = mac_addr_used; 96 97 while (count--) { 98 u8 *p = mac + ETH_ALEN - 1; 99 100 do { 101 (*p)++; 102 if (*p != 0) 103 break; 104 p--; 105 } while (p != oui); 106 107 if (p == oui) { 108 pr_err("unable to fetch mac address\n"); 109 return -ENODEV; 110 } 111 } 112 113 mac_addr_used++; 114 return 0; 115 } 116 EXPORT_SYMBOL(bcm63xx_nvram_get_mac_address); 117