adm5120: include r21398 actual changes
[openwrt/svn-archive/archive.git] / target / linux / adm5120 / files-2.6.34 / arch / mips / adm5120 / prom / routerboot.c
1 /*
2 * Mikrotik's RouterBOOT specific prom routines
3 *
4 * Copyright (C) 2007-2008 Gabor Juhos <juhosg@openwrt.org>
5 *
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License version 2 as published
8 * by the Free Software Foundation.
9 *
10 */
11
12 #include <linux/types.h>
13 #include <generated/autoconf.h>
14 #include <linux/kernel.h>
15 #include <linux/init.h>
16 #include <linux/string.h>
17 #include <linux/module.h>
18
19 #include <asm/bootinfo.h>
20 #include <asm/addrspace.h>
21
22 #include <asm/mach-adm5120/adm5120_defs.h>
23 #include <prom/routerboot.h>
24 #include "prom_read.h"
25
26 struct rb_hard_settings rb_hs;
27 static int rb_found;
28
29 static int __init routerboot_load_hs(u8 *buf, u16 buflen)
30 {
31 u16 id, len;
32
33 memset(&rb_hs, 0, sizeof(rb_hs));
34
35 if (buflen < 4)
36 return -1;
37
38 if (prom_read_le32(buf) != RB_MAGIC_HARD)
39 return -1;
40
41 /* skip magic value */
42 buf += 4;
43 buflen -= 4;
44
45 while (buflen > 2) {
46 id = prom_read_le16(buf);
47 buf += 2;
48 buflen -= 2;
49 if (id == RB_ID_TERMINATOR || buflen < 2)
50 break;
51
52 len = prom_read_le16(buf);
53 buf += 2;
54 buflen -= 2;
55
56 if (buflen < len)
57 break;
58
59 switch (id) {
60 case RB_ID_BIOS_VERSION:
61 rb_hs.bios_ver = (char *)buf;
62 break;
63 case RB_ID_BOARD_NAME:
64 rb_hs.name = (char *)buf;
65 break;
66 case RB_ID_MEMORY_SIZE:
67 rb_hs.mem_size = prom_read_le32(buf);
68 break;
69 case RB_ID_MAC_ADDRESS_COUNT:
70 rb_hs.mac_count = prom_read_le32(buf);
71 break;
72 case RB_ID_MAC_ADDRESS_PACK:
73 if ((len / RB_MAC_SIZE) > 0)
74 rb_hs.mac_base = buf;
75 break;
76 }
77
78 buf += len;
79 buflen -= len;
80
81 }
82
83 return 0;
84 }
85
86 #define RB_BS_OFFS 0x14
87 #define RB_OFFS_MAX (128*1024)
88
89 int __init routerboot_present(void)
90 {
91 struct rb_bios_settings *bs;
92 u8 *base;
93 u32 off, len;
94
95 if (rb_found)
96 goto out;
97
98 base = (u8 *)KSEG1ADDR(ADM5120_SRAM0_BASE);
99 bs = (struct rb_bios_settings *)(base + RB_BS_OFFS);
100
101 off = prom_read_le32(&bs->hs_offs);
102 len = prom_read_le32(&bs->hs_size);
103 if (off > RB_OFFS_MAX)
104 goto out;
105
106 if (routerboot_load_hs(base+off, len) != 0)
107 goto out;
108
109 rb_found = 1;
110
111 out:
112 return rb_found;
113 }
114
115 char *routerboot_get_boardname(void)
116 {
117 if (rb_found == 0)
118 return NULL;
119
120 return rb_hs.name;
121 }