76 lines
2.2 KiB
C
76 lines
2.2 KiB
C
|
/*
|
||
|
|
* $Id$
|
||
|
|
*
|
||
|
|
* Compex's MyLoader specific prom routines
|
||
|
|
*
|
||
|
|
* Copyright (C) 2007 OpenWrt.org
|
||
|
|
* Copyright (C) 2007 Gabor Juhos <juhosg@freemail.hu>
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or
|
||
|
|
* modify it under the terms of the GNU General Public License
|
||
|
|
* as published by the Free Software Foundation; either version 2
|
||
|
|
* of the License, or (at your option) any later version.
|
||
|
|
*
|
||
|
|
* This program is distributed in the hope that it will be useful,
|
||
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
|
* GNU General Public License for more details.
|
||
|
|
*
|
||
|
|
* You should have received a copy of the GNU General Public License
|
||
|
|
* along with this program; if not, write to the
|
||
|
|
* Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor,
|
||
|
|
* Boston, MA 02110-1301, USA.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/types.h>
|
||
|
|
#include <linux/autoconf.h>
|
||
|
|
#include <linux/kernel.h>
|
||
|
|
#include <linux/init.h>
|
||
|
|
#include <linux/string.h>
|
||
|
|
|
||
|
|
#include <asm/bootinfo.h>
|
||
|
|
#include <asm/addrspace.h>
|
||
|
|
#include <asm/byteorder.h>
|
||
|
|
|
||
|
|
#include <adm5120_defs.h>
|
||
|
|
#include <prom/myloader.h>
|
||
|
|
#include "prom_read.h"
|
||
|
|
|
||
|
|
#define SYS_PARAMS_ADDR KSEG1ADDR(ADM5120_SRAM0_BASE+0x0F000)
|
||
|
|
#define BOARD_PARAMS_ADDR KSEG1ADDR(ADM5120_SRAM0_BASE+0x0F800)
|
||
|
|
#define PART_TABLE_ADDR KSEG1ADDR(ADM5120_SRAM0_BASE+0x10000)
|
||
|
|
|
||
|
|
static int myloader_found = 0;
|
||
|
|
|
||
|
|
struct myloader_info myloader_info;
|
||
|
|
|
||
|
|
int __init myloader_present(void)
|
||
|
|
{
|
||
|
|
struct mylo_system_params *sysp;
|
||
|
|
struct mylo_board_params *boardp;
|
||
|
|
struct mylo_partition_table *parts;
|
||
|
|
|
||
|
|
if (myloader_found)
|
||
|
|
goto out;
|
||
|
|
|
||
|
|
sysp = (struct mylo_system_params *)(SYS_PARAMS_ADDR);
|
||
|
|
boardp = (struct mylo_board_params *)(BOARD_PARAMS_ADDR);
|
||
|
|
parts = (struct mylo_partition_table *)(PART_TABLE_ADDR);
|
||
|
|
|
||
|
|
/* Check for some magic numbers */
|
||
|
|
if ((le32_to_cpu(sysp->magic) != MYLO_MAGIC_SYS_PARAMS) ||
|
||
|
|
(le32_to_cpu(boardp->magic) != MYLO_MAGIC_BOARD_PARAMS) ||
|
||
|
|
(le32_to_cpu(parts->magic) != MYLO_MAGIC_PARTITIONS))
|
||
|
|
goto out;
|
||
|
|
|
||
|
|
myloader_info.vid = le32_to_cpu(sysp->vid);
|
||
|
|
myloader_info.did = le32_to_cpu(sysp->did);
|
||
|
|
myloader_info.svid = le32_to_cpu(sysp->svid);
|
||
|
|
myloader_info.sdid = le32_to_cpu(sysp->sdid);
|
||
|
|
|
||
|
|
myloader_found = 1;
|
||
|
|
|
||
|
|
out:
|
||
|
|
return myloader_found;
|
||
|
|
}
|