ar7: drop 3.14 support
[oweals/openwrt.git] / target / linux / adm5120 / files-3.8 / 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 <linux/kernel.h>
14 #include <linux/init.h>
15 #include <linux/string.h>
16 #include <linux/module.h>
17 #include <linux/routerboot.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 }