Orange Pi5 kernel

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