aboutsummaryrefslogtreecommitdiffstats
path: root/target/linux/brcm63xx/patches-3.1/250-boardid_fixup.patch
blob: a80a23fae33b4f1cf479e5163a279aba4a613cc5 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
--- a/arch/mips/bcm63xx/boards/board_bcm963xx.c
+++ b/arch/mips/bcm63xx/boards/board_bcm963xx.c
@@ -32,9 +32,13 @@
 #include <bcm63xx_dev_usb_udc.h>
 #include <bcm63xx_dev_spi.h>
 #include <board_bcm963xx.h>
+#include <bcm_tag.h>
 
 #define PFX	"board_bcm963xx: "
 
+#define CFE_OFFSET_64K		0x10000
+#define CFE_OFFSET_128K		0x20000
+
 static struct bcm963xx_nvram nvram;
 static unsigned int mac_addr_used;
 static struct board_info board;
@@ -734,6 +738,29 @@ static int board_get_mac_address(u8 *mac
 	return 0;
 }
 
+static void __init boardid_fixup(u8 *boot_addr)
+{
+	struct bcm_tag *tag = (struct bcm_tag *)(boot_addr + CFE_OFFSET_64K);
+
+	/* check if bcm_tag is at 64k offset */
+	if (strncmp(nvram.name, tag->boardid, BOARDID_LEN) != 0) {
+		/* else try 128k */
+		tag = (struct bcm_tag *)(boot_addr + CFE_OFFSET_128K);
+		if (strncmp(nvram.name, tag->boardid, BOARDID_LEN) != 0) {
+			/* No tag found */
+			printk(KERN_DEBUG "No bcm_tag found!\n");
+			return;
+		}
+	}
+	/* check if we should override the boardid */
+	if (tag->information1[0] != '+')
+		return;
+
+	strncpy(nvram.name, &tag->information1[1], BOARDID_LEN);
+
+	printk(KERN_INFO "Overriding boardid with '%s'\n", nvram.name);
+}
+
 /*
  * early init callback, read nvram data from flash and checksum it
  */
@@ -776,6 +803,11 @@ void __init board_prom_init(void)
 		return;
 	}
 
+	if (strcmp(cfe_version, "unknown") != 0) {
+		/* cfe present */
+		boardid_fixup(boot_addr);
+	}
+
 	/* find board by name */
 	for (i = 0; i < ARRAY_SIZE(bcm963xx_boards); i++) {
 		if (strncmp(nvram.name, bcm963xx_boards[i]->name,