target/linux/adm5120/files/arch/mips/adm5120/prom/routerboot.c

   1 /*
   2  *  $Id$
   3  *
   4  *  Mikrotik's RouterBOOT specific prom routines
   5  *
   6  *  Copyright (C) 2007 OpenWrt.org
   7  *  Copyright (C) 2007 Gabor Juhos <juhosg at openwrt.org>
   8  *
   9  *  This program is free software; you can redistribute it and/or
  10  *  modify it under the terms of the GNU General Public License
  11  *  as published by the Free Software Foundation; either version 2
  12  *  of the License, or (at your option) any later version.
  13  *
  14  *  This program is distributed in the hope that it will be useful,
  15  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  *  GNU General Public License for more details.
  18  *
  19  *  You should have received a copy of the GNU General Public License
  20  *  along with this program; if not, write to the
  21  *  Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor,
  22  *  Boston, MA  02110-1301, USA.
  23  */
  24
  25 #include <linux/types.h>
  26 #include <linux/autoconf.h>
  27 #include <linux/kernel.h>
  28 #include <linux/init.h>
  29 #include <linux/string.h>
  30 #include <linux/module.h>
  31
  32 #include <asm/bootinfo.h>
  33 #include <asm/addrspace.h>
  34
  35 #include <adm5120_defs.h>
  36 #include <prom/routerboot.h>
  37 #include "prom_read.h"
  38
  39 struct rb_hard_settings rb_hs;
  40 EXPORT_SYMBOL(rb_hs);
  41 static int rb_found;
  42
  43 static int __init routerboot_load_hs(u8 *buf, u16 buflen)
  44 {
  45         u16 id, len;
  46         u8 *mac;
  47         int i, j;
  48
  49         memset(&rb_hs, 0, sizeof(rb_hs));
  50
  51         if (buflen < 4)
  52                 return -1;
  53
  54         if (prom_read_le32(buf) != RB_MAGIC_HARD)
  55                 return -1;
  56
  57         /* skip magic value */
  58         buf += 4;
  59         buflen -= 4;
  60
  61         while (buflen > 2) {
  62                 id = prom_read_le16(buf);
  63                 buf += 2;
  64                 buflen -= 2;
  65                 if (id == RB_ID_TERMINATOR || buflen < 2)
  66                         break;
  67
  68                 len = prom_read_le16(buf);
  69                 buf += 2;
  70                 buflen -= 2;
  71
  72                 if (buflen < len)
  73                         break;
  74
  75                 switch (id) {
  76                 case RB_ID_BIOS_VERSION:
  77                         rb_hs.bios_ver = (char *)buf;
  78                         break;
  79                 case RB_ID_BOARD_NAME:
  80                         rb_hs.name = (char *)buf;
  81                         break;
  82                 case RB_ID_MEMORY_SIZE:
  83                         rb_hs.mem_size = prom_read_le32(buf);
  84                         break;
  85                 case RB_ID_MAC_ADDRESS_COUNT:
  86                         rb_hs.mac_count = prom_read_le32(buf);
  87                         break;
  88                 case RB_ID_MAC_ADDRESS_PACK:
  89                         rb_hs.mac_count = len/RB_MAC_SIZE;
  90                         if (rb_hs.mac_count > RB_MAX_MAC_COUNT)
  91                                 rb_hs.mac_count = RB_MAX_MAC_COUNT;
  92                         mac = buf;
  93                         for (i = 0; i < rb_hs.mac_count; i++) {
  94                                 for (j = 0; j < RB_MAC_SIZE; j++)
  95                                         rb_hs.macs[i][j] = mac[j];
  96                                 mac += RB_MAC_SIZE;
  97                         }
  98                         break;
  99                 }
 100
 101                 buf += len;
 102                 buflen -= len;
 103
 104         }
 105
 106         return 0;
 107 }
 108
 109 #define RB_BS_OFFS      0x14
 110 #define RB_OFFS_MAX     (128*1024)
 111
 112 int __init routerboot_present(void)
 113 {
 114         struct rb_bios_settings *bs;
 115         u8 *base;
 116         u32 off, len;
 117
 118         if (rb_found)
 119                 goto out;
 120
 121         base = (u8 *)KSEG1ADDR(ADM5120_SRAM0_BASE);
 122         bs = (struct rb_bios_settings *)(base + RB_BS_OFFS);
 123
 124         off = prom_read_le32(&bs->hs_offs);
 125         len = prom_read_le32(&bs->hs_size);
 126         if (off > RB_OFFS_MAX)
 127                 goto out;
 128
 129         if (routerboot_load_hs(base+off, len) != 0)
 130                 goto out;
 131
 132         rb_found = 1;
 133
 134 out:
 135         return rb_found;
 136 }
 137
 138 char *routerboot_get_boardname(void)
 139 {
 140         if (rb_found == 0)
 141                 return NULL;
 142
 143         return rb_hs.name;
 144 }