From ce6ad137a61c454a5118fd7ca96f3176a0490302 Mon Sep 17 00:00:00 2001 From: juhosg Date: Wed, 20 Aug 2008 17:20:58 +0000 Subject: [PATCH] [adm5120] load the mac address from flash where it is possible git-svn-id: svn://svn.openwrt.org/openwrt/trunk@12357 3c298f89-4303-0410-b956-a3cf2f4a3e73 --- .../arch/mips/adm5120/cellvision/cellvision.c | 21 +++++++++ .../arch/mips/adm5120/cellvision/cellvision.h | 3 ++ .../arch/mips/adm5120/cellvision/nfs-101.c | 2 + .../arch/mips/adm5120/common/platform.c | 20 ++++++++ .../arch/mips/adm5120/compex/compex.c | 37 +++++++-------- .../arch/mips/adm5120/compex/compex.h | 3 +- .../arch/mips/adm5120/edimax/br-61xx.c | 22 ++++++++- .../arch/mips/adm5120/edimax/br-61xx.h | 1 + .../arch/mips/adm5120/infineon/infineon.c | 23 ++++++++++ .../arch/mips/adm5120/infineon/infineon.h | 3 +- .../arch/mips/adm5120/mikrotik/rb-1xx.c | 14 +++--- .../arch/mips/adm5120/mikrotik/rb-1xx.h | 1 + .../arch/mips/adm5120/prom/Makefile | 1 + .../arch/mips/adm5120/prom/admboot.c | 46 +++++++++++++++++++ .../arch/mips/adm5120/prom/bootbase.c | 9 ++++ .../arch/mips/adm5120/zyxel/p-33x.c | 4 ++ .../arch/mips/adm5120/zyxel/p-33x.h | 4 +- .../asm-mips/mach-adm5120/adm5120_platform.h | 2 + .../asm-mips/mach-adm5120/prom/admboot.h | 17 +++++++ 19 files changed, 200 insertions(+), 33 deletions(-) create mode 100644 target/linux/adm5120/files-2.6.26/arch/mips/adm5120/prom/admboot.c create mode 100644 target/linux/adm5120/files-2.6.26/include/asm-mips/mach-adm5120/prom/admboot.h diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/cellvision/cellvision.c b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/cellvision/cellvision.c index 2b90ce16d..15aa5feb9 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/cellvision/cellvision.c +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/cellvision/cellvision.c @@ -11,9 +11,14 @@ #include "cellvision.h" +#include + #define CELLVISION_GPIO_FLASH_A20 ADM5120_GPIO_PIN5 #define CELLVISION_GPIO_DEV_MASK (1 << CELLVISION_GPIO_FLASH_A20) +#define CELLVISION_CONFIG_OFFSET 0x8000 +#define CELLVISION_CONFIG_SIZE 0x1000 + #ifdef CONFIG_MTD_PARTITIONS static struct mtd_partition cas6xx_partitions[] = { { @@ -84,6 +89,20 @@ static void __init cellvision_flash_setup(void) adm5120_add_device_flash(0); } +void __init cellvision_mac_setup(void) +{ + u8 mac_base[6]; + int err; + + err = admboot_get_mac_base(CELLVISION_CONFIG_OFFSET, + CELLVISION_CONFIG_SIZE, mac_base); + + if ((err) || !is_valid_ether_addr(mac_base)) + random_ether_addr(mac_base); + + adm5120_setup_eth_macs(mac_base); +} + void __init cas6xx_flash_setup(void) { #ifdef CONFIG_MTD_PARTITIONS @@ -118,6 +137,8 @@ ADM5120_BOARD(MACH_ADM5120_CAS670, "Cellvision CAS-670/670W", cas6xx_setup); void __init cas7xx_setup(void) { cas7xx_flash_setup(); + + cellvision_mac_setup(); adm5120_add_device_switch(1, NULL); } diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/cellvision/cellvision.h b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/cellvision/cellvision.h index c7c6a1e19..70742e9b5 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/cellvision/cellvision.h +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/cellvision/cellvision.h @@ -12,6 +12,7 @@ #include #include #include +#include #include @@ -20,6 +21,8 @@ #include #include +extern void cellvision_mac_setup(void) __init; + extern void cas6xx_flash_setup(void) __init; extern void cas7xx_flash_setup(void) __init; extern void cas6xx_setup(void) __init; diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/cellvision/nfs-101.c b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/cellvision/nfs-101.c index efd4e5758..700919ca2 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/cellvision/nfs-101.c +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/cellvision/nfs-101.c @@ -18,6 +18,8 @@ static u8 nfs101_vlans[6] __initdata = { /* TODO: not tested */ static void __init nfs101_setup(void) { cas6xx_flash_setup(); + + cellvision_mac_setup(); adm5120_add_device_switch(5, nfs101_vlans); } diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/common/platform.c b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/common/platform.c index e58560e00..5cae2023f 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/common/platform.c +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/common/platform.c @@ -50,6 +50,26 @@ unsigned char adm5120_eth_vlans[6] = { EXPORT_SYMBOL_GPL(adm5120_eth_vlans); #endif +void __init adm5120_setup_eth_macs(u8 *mac_base) +{ + u32 t; + int i, j; + + t = ((u32) mac_base[3] << 16) | ((u32) mac_base[4] << 8) + | ((u32) mac_base[5]); + + for (i = 0; i < ARRAY_SIZE(adm5120_eth_macs); i++) { + for (j = 0; j < 3; j++) + adm5120_eth_macs[i][j] = mac_base[j]; + + adm5120_eth_macs[i][3] = (t >> 16) & 0xff; + adm5120_eth_macs[i][4] = (t >> 8) & 0xff; + adm5120_eth_macs[i][5] = t & 0xff; + + t++; + } +} + /* * Built-in ethernet switch */ diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/compex/compex.c b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/compex/compex.c index 10120d622..81157812b 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/compex/compex.c +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/compex/compex.c @@ -9,21 +9,10 @@ * */ -#include -#include -#include - -#include - -#include -#include -#include -#include +#include "compex.h" #include -#include "compex.h" - #define COMPEX_GPIO_DEV_MASK (1 << ADM5120_GPIO_PIN5) static void switch_bank_gpio5(unsigned bank) @@ -40,14 +29,22 @@ static void switch_bank_gpio5(unsigned bank) void __init compex_mac_setup(void) { - int i, j; - - if (!myloader_present()) - return; - - for (i = 0; i < 6; i++) - for (j = 0; j < 6; j++) - adm5120_eth_macs[i][j] = myloader_info.macs[i][j]; + if (myloader_present()) { + int i; + + for (i = 0; i < 6; i++) { + if (is_valid_ether_addr(myloader_info.macs[i])) + memcpy(myloader_info.macs[i], + adm5120_eth_macs[i], ETH_ALEN); + else + random_ether_addr(adm5120_eth_macs[i]); + } + } else { + u8 mac[ETH_ALEN]; + + random_ether_addr(mac); + adm5120_setup_eth_macs(mac); + } } void __init compex_generic_setup(void) diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/compex/compex.h b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/compex/compex.h index ac2fb6939..739a90d02 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/compex/compex.h +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/compex/compex.h @@ -11,9 +11,10 @@ #include #include +#include +#include #include -#include #include #include diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/edimax/br-61xx.c b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/edimax/br-61xx.c index 33bff8706..e78471328 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/edimax/br-61xx.c +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/edimax/br-61xx.c @@ -11,8 +11,13 @@ #include "br-61xx.h" +#include + #define BR61XX_GPIO_DEV_MASK 0 +#define BR61XX_CONFIG_OFFSET 0x8000 +#define BR61XX_CONFIG_SIZE 0x1000 + #ifdef CONFIG_MTD_PARTITIONS static struct mtd_partition br61xx_partitions[] = { { @@ -46,6 +51,20 @@ static u8 br61xx_vlans[6] __initdata = { 0x41, 0x42, 0x44, 0x48, 0x50, 0x00 }; +static void __init br61xx_mac_setup(void) +{ + u8 mac_base[6]; + int err; + + err = admboot_get_mac_base(BR61XX_CONFIG_OFFSET, + BR61XX_CONFIG_SIZE, mac_base); + + if ((err) || !is_valid_ether_addr(mac_base)) + random_ether_addr(mac_base); + + adm5120_setup_eth_macs(mac_base); +} + void __init br61xx_generic_setup(void) { @@ -56,9 +75,10 @@ void __init br61xx_generic_setup(void) adm5120_add_device_flash(0); adm5120_add_device_gpio(BR61XX_GPIO_DEV_MASK); + adm5120_add_device_switch(5, br61xx_vlans); adm5120_add_device_gpio_buttons(ARRAY_SIZE(br61xx_gpio_buttons), br61xx_gpio_buttons); - /* TODO: setup mac addresses */ + br61xx_mac_setup(); } diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/edimax/br-61xx.h b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/edimax/br-61xx.h index fff478977..d7efda32d 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/edimax/br-61xx.h +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/edimax/br-61xx.h @@ -12,6 +12,7 @@ #include #include #include +#include #include diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/infineon/infineon.c b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/infineon/infineon.c index 9d898b7ac..bbe8c7195 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/infineon/infineon.c +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/infineon/infineon.c @@ -11,6 +11,11 @@ #include "infineon.h" +#include + +#define EASY_CONFIG_OFFSET 0x10000 +#define EASY_CONFIG_SIZE 0x1000 + #ifdef CONFIG_MTD_PARTITIONS static struct mtd_partition easy_partitions[] = { { @@ -30,6 +35,20 @@ static struct mtd_partition easy_partitions[] = { }; #endif /* CONFIG_MTD_PARTITIONS */ +static __init void easy_setup_mac(void) +{ + u8 mac_base[6]; + int err; + + err = admboot_get_mac_base(EASY_CONFIG_OFFSET, + EASY_CONFIG_SIZE, mac_base); + + if ((err) || !is_valid_ether_addr(mac_base)) + random_ether_addr(mac_base); + + adm5120_setup_eth_macs(mac_base); +} + static void switch_bank_gpio3(unsigned bank) { switch (bank) { @@ -55,6 +74,8 @@ void __init easy_setup_pqfp(void) #endif /* CONFIG_MTD_PARTITIONS */ adm5120_add_device_flash(0); + + easy_setup_mac(); } static void switch_bank_gpio5(unsigned bank) @@ -82,4 +103,6 @@ void __init easy_setup_bga(void) #endif /* CONFIG_MTD_PARTITIONS */ adm5120_add_device_flash(0); + + easy_setup_mac(); } diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/infineon/infineon.h b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/infineon/infineon.h index 1d96cc1f1..f3b28e088 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/infineon/infineon.h +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/infineon/infineon.h @@ -11,9 +11,10 @@ #include #include +#include +#include #include -#include #include #include diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/mikrotik/rb-1xx.c b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/mikrotik/rb-1xx.c index dd506aa1c..8edca5bcb 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/mikrotik/rb-1xx.c +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/mikrotik/rb-1xx.c @@ -101,15 +101,13 @@ struct gpio_button rb1xx_gpio_buttons[] __initdata = { static void __init rb1xx_mac_setup(void) { - int i, j; + if (rb_hs.mac_base != NULL && is_valid_ether_addr(rb_hs.mac_base)) { + adm5120_setup_eth_macs(rb_hs.mac_base); + } else { + u8 mac[ETH_ALEN]; - if (!rb_hs.mac_base) - return; - - for (i = 0; i < 6; i++) { - for (j = 0; j < 5; j++) - adm5120_eth_macs[i][j] = rb_hs.mac_base[j]; - adm5120_eth_macs[i][5] = rb_hs.mac_base[5]+i; + random_ether_addr(mac); + adm5120_setup_eth_macs(mac); } } diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/mikrotik/rb-1xx.h b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/mikrotik/rb-1xx.h index ebc514c65..d5acef028 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/mikrotik/rb-1xx.h +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/mikrotik/rb-1xx.h @@ -13,6 +13,7 @@ #include #include #include +#include #include diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/prom/Makefile b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/prom/Makefile index d844b600f..650be4077 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/prom/Makefile +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/prom/Makefile @@ -2,6 +2,7 @@ # Makefile for the ADMtek ADM5120 SoC specific parts of the kernel # +lib-y += admboot.o lib-y += bootbase.o lib-y += cfe.o lib-y += generic.o diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/prom/admboot.c b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/prom/admboot.c new file mode 100644 index 000000000..5d436f62f --- /dev/null +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/prom/admboot.c @@ -0,0 +1,46 @@ +/* + * ADMBoot specific prom routines + * + * Copyright (C) 2008 Gabor Juhos + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of the GNU General Public License version 2 as published + * by the Free Software Foundation. + * + */ + +#include +#include +#include + +#include +#include + +#include +#include +#include "prom_read.h" + +#define ADMBOOT_MAGIC_MAC_BASE 0x636D676D /* 'mgmc' */ + +int __init admboot_get_mac_base(u32 offset, u32 len, u8 *mac) +{ + u8 *cfg; + int i; + + cfg = (u8 *) KSEG1ADDR(ADM5120_SRAM0_BASE + offset); + for (i = 0; i < len; i += 4) { + u32 magic; + + magic = prom_read_le32(cfg + i); + if (magic == ADMBOOT_MAGIC_MAC_BASE) { + int j; + + for (j = 0; j < 6; j++) + mac[j] = cfg[i + 4 + j]; + + return 0; + } + } + + return -ENXIO; +} diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/prom/bootbase.c b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/prom/bootbase.c index 23f8e1462..b6a94ff46 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/prom/bootbase.c +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/prom/bootbase.c @@ -53,6 +53,14 @@ static inline u32 bootbase_get_bootext_addr(void) return prom_read_be32(&board_info->bootext_addr); } +static inline void bootbase_get_mac(u8 *mac) +{ + int i; + + for (i = 0; i < 6; i++) + mac[i] = board_info->mac[i]; +} + static inline u16 bootbase_get_vendor_id(void) { #define CHECK_VENDOR(n) (strnicmp(board_info->vendor, (n), strlen(n)) == 0) @@ -102,6 +110,7 @@ int __init bootbase_present(void) bootbase_info.vendor_id = bootbase_get_vendor_id(); bootbase_info.board_id = bootbase_get_board_id(); + bootbase_get_mac(bootbase_info.mac); bootbase_found = 1; diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/zyxel/p-33x.c b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/zyxel/p-33x.c index f27a80c15..2a83c9b2a 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/zyxel/p-33x.c +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/zyxel/p-33x.c @@ -11,6 +11,8 @@ #include "p-33x.h" +#include + #define P33X_GPIO_FLASH_A20 ADM5120_GPIO_PIN5 #define P33X_GPIO_DEV_MASK (1 << P33X_GPIO_FLASH_A20) @@ -76,6 +78,8 @@ void __init p33x_generic_setup(void) adm5120_add_device_flash(0); adm5120_add_device_gpio(P33X_GPIO_DEV_MASK); + + adm5120_setup_eth_macs(bootbase_info.mac); adm5120_add_device_switch(5, p33x_vlans); adm5120_pci_set_irq_map(ARRAY_SIZE(p33x_pci_irqs), p33x_pci_irqs); diff --git a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/zyxel/p-33x.h b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/zyxel/p-33x.h index faff3bd72..4817e8105 100644 --- a/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/zyxel/p-33x.h +++ b/target/linux/adm5120/files-2.6.26/arch/mips/adm5120/zyxel/p-33x.h @@ -11,12 +11,12 @@ #include #include +#include #include -#include #include #include #include -extern void p33x_generic_setup(void) __init; \ No newline at end of file +extern void p33x_generic_setup(void) __init; diff --git a/target/linux/adm5120/files-2.6.26/include/asm-mips/mach-adm5120/adm5120_platform.h b/target/linux/adm5120/files-2.6.26/include/asm-mips/mach-adm5120/adm5120_platform.h index 24f38e399..9d2e430cd 100644 --- a/target/linux/adm5120/files-2.6.26/include/asm-mips/mach-adm5120/adm5120_platform.h +++ b/target/linux/adm5120/files-2.6.26/include/asm-mips/mach-adm5120/adm5120_platform.h @@ -57,6 +57,8 @@ static inline void adm5120_pci_set_irq_map(unsigned int nr_irqs, } #endif +extern void adm5120_setup_eth_macs(u8 *mac_base) __init; + extern struct adm5120_flash_platform_data adm5120_flash0_data; extern struct adm5120_flash_platform_data adm5120_flash1_data; diff --git a/target/linux/adm5120/files-2.6.26/include/asm-mips/mach-adm5120/prom/admboot.h b/target/linux/adm5120/files-2.6.26/include/asm-mips/mach-adm5120/prom/admboot.h new file mode 100644 index 000000000..fa42bf714 --- /dev/null +++ b/target/linux/adm5120/files-2.6.26/include/asm-mips/mach-adm5120/prom/admboot.h @@ -0,0 +1,17 @@ +/* + * ADMBoot specific definitions + * + * Copyright (C) 2008 Gabor Juhos + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of the GNU General Public License version 2 as published + * by the Free Software Foundation. + * + */ + +#ifndef _ADMBOOT_H +#define _ADMBOOT_H + +extern int admboot_get_mac_base(u32 offset, u32 len, u8 *mac) __init; + +#endif /* _ADMBOOT_H */ -- 2.20.1