mirror of
git://projects.qi-hardware.com/openwrt-xburst.git
synced 2025-04-21 12:27:27 +03:00
[adm5120] refactor kernel code (part 1), mark it as broken now
git-svn-id: svn://svn.openwrt.org/openwrt/trunk@7916 3c298f89-4303-0410-b956-a3cf2f4a3e73
This commit is contained in:
@@ -1,96 +1,160 @@
|
||||
/*****************************************************************************
|
||||
* Carsten Langgaard, carstenl@mips.com
|
||||
* Copyright (C) 1999,2000 MIPS Technologies, Inc. All rights reserved.
|
||||
* Copyright (C) 2003 ADMtek Incorporated.
|
||||
* daniell@admtek.com.tw
|
||||
* Copyright (C) 2007 OpenWrt.org
|
||||
/*
|
||||
* $Id$
|
||||
*
|
||||
* This program is free software; you can distribute it and/or modify it
|
||||
* under the terms of the GNU General Public License (Version 2) as
|
||||
* published by the Free Software Foundation.
|
||||
* ADM5120 specific prom routines
|
||||
*
|
||||
* This program is distributed in the hope 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.
|
||||
* Copyright (C) 2007 OpenWrt.org
|
||||
* Copyright (C) 2007 Gabor Juhos <juhosg@freemail.hu>
|
||||
*
|
||||
* 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.,
|
||||
* 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
|
||||
* 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/init.h>
|
||||
#include <linux/autoconf.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/string.h>
|
||||
#include <linux/mm.h>
|
||||
#include <linux/bootmem.h>
|
||||
|
||||
#include <asm/bootinfo.h>
|
||||
#include <asm/addrspace.h>
|
||||
|
||||
#include <asm/mach-adm5120/adm5120_info.h>
|
||||
#include <asm/mach-adm5120/adm5120_defs.h>
|
||||
#include <asm/mach-adm5120/adm5120_uart.h>
|
||||
|
||||
static char **prom_envp = NULL;
|
||||
#include <prom/cfe.h>
|
||||
#include <prom/generic.h>
|
||||
#include <prom/routerboot.h>
|
||||
#include <prom/myloader.h>
|
||||
#include <prom/zynos.h>
|
||||
|
||||
void setup_prom_printf(int);
|
||||
void prom_printf(char *, ...);
|
||||
void prom_meminit(void);
|
||||
unsigned int adm5120_prom_type = ADM5120_PROM_GENERIC;
|
||||
|
||||
struct board_desc {
|
||||
unsigned long mach_type;
|
||||
char *name;
|
||||
};
|
||||
|
||||
#define READCSR(r) *(volatile unsigned long *)(0xB2600000+(r))
|
||||
#define WRITECSR(r,v) *(volatile unsigned long *)(0xB2600000+(r)) = v
|
||||
#define DEFBOARD(n, mt) { .mach_type = (mt), .name = (n)}
|
||||
static struct board_desc common_boards[] __initdata = {
|
||||
/* Cellvision/SparkLAN boards */
|
||||
DEFBOARD("CAS-630", MACH_ADM5120_CAS630),
|
||||
DEFBOARD("CAS-670", MACH_ADM5120_CAS670),
|
||||
DEFBOARD("CAS-771", MACH_ADM5120_CAS771),
|
||||
DEFBOARD("CAS-790", MACH_ADM5120_CAS790),
|
||||
DEFBOARD("CAS-861", MACH_ADM5120_CAS861),
|
||||
/* Compex boards */
|
||||
DEFBOARD("WP54G-WRT", MACH_ADM5120_WP54G_WRT),
|
||||
/* Edimax boards */
|
||||
DEFBOARD("BR-6104K", MACH_ADM5120_BR6104K),
|
||||
DEFBOARD("BR-6104KP", MACH_ADM5120_BR6104K),
|
||||
/* Infineon boards */
|
||||
DEFBOARD("EASY 5120", MACH_ADM5120_EASY5120),
|
||||
DEFBOARD("EASY 5120-RT", MACH_ADM5120_EASY5120RT),
|
||||
DEFBOARD("EASY 5120P-ATA", MACH_ADM5120_EASY5120PATA),
|
||||
DEFBOARD("EASY 83000", MACH_ADM5120_EASY83000),
|
||||
/* Mikrotik RouterBOARDs */
|
||||
DEFBOARD("111", MACH_ADM5120_RB_111),
|
||||
DEFBOARD("112", MACH_ADM5120_RB_112),
|
||||
DEFBOARD("133", MACH_ADM5120_RB_133),
|
||||
DEFBOARD("133C", MACH_ADM5120_RB_133C),
|
||||
DEFBOARD("miniROUTER", MACH_ADM5120_RB_150),
|
||||
DEFBOARD("153", MACH_ADM5120_RB_153),
|
||||
};
|
||||
|
||||
#define UART_DR_REG 0x00
|
||||
#define UART_FR_REG 0x18
|
||||
#define UART_TX_FIFO_FULL 0x20
|
||||
|
||||
int putPromChar(char c)
|
||||
static unsigned long __init find_machtype_byname(char *name)
|
||||
{
|
||||
WRITECSR(UART_DR_REG, c);
|
||||
while ( (READCSR(UART_FR_REG) & UART_TX_FIFO_FULL) );
|
||||
return 0;
|
||||
unsigned long ret;
|
||||
int i;
|
||||
|
||||
ret = MACH_ADM5120_GENERIC;
|
||||
if (name == NULL)
|
||||
goto out;
|
||||
|
||||
if (*name == '\0')
|
||||
goto out;
|
||||
|
||||
for (i=0; i<ARRAY_SIZE(common_boards); i++) {
|
||||
if (strcmp(common_boards[i].name, name) == 0) {
|
||||
ret = common_boards[i].mach_type;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
out:
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* Ugly prom_printf used for debugging
|
||||
*/
|
||||
|
||||
void prom_printf(char *fmt, ...)
|
||||
static unsigned long __init detect_machtype_routerboot(void)
|
||||
{
|
||||
va_list args;
|
||||
int l;
|
||||
char *p, *buf_end;
|
||||
char buf[1024];
|
||||
char *name;
|
||||
|
||||
va_start(args, fmt);
|
||||
l = vsprintf(buf, fmt, args); /* hopefully i < sizeof(buf) */
|
||||
va_end(args);
|
||||
|
||||
buf_end = buf + l;
|
||||
|
||||
for (p = buf; p < buf_end; p++) {
|
||||
/* Crude cr/nl handling is better than none */
|
||||
if (*p == '\n')
|
||||
putPromChar('\r');
|
||||
putPromChar(*p);
|
||||
}
|
||||
name = routerboot_get_boardname();
|
||||
return find_machtype_byname(name);
|
||||
}
|
||||
|
||||
char *prom_getenv(char *envname)
|
||||
static unsigned long __init detect_machtype_generic(void)
|
||||
{
|
||||
char **env;
|
||||
char *ret;
|
||||
char *name;
|
||||
|
||||
ret = NULL;
|
||||
name = generic_prom_getenv("board");
|
||||
return find_machtype_byname(name);
|
||||
}
|
||||
|
||||
if (prom_envp== NULL)
|
||||
return NULL;
|
||||
unsigned long __init detect_machtype_cfe(void)
|
||||
{
|
||||
char *name;
|
||||
|
||||
for (env = prom_envp; *env != NULL; env++) {
|
||||
if (strcmp(envname, *env++) == 0) {
|
||||
ret = *env;
|
||||
name = cfe_getenv("BOARD_NAME");
|
||||
return find_machtype_byname(name);
|
||||
}
|
||||
|
||||
static struct {
|
||||
unsigned long mach_type;
|
||||
u16 vendor_id;
|
||||
u16 board_id;
|
||||
} zynos_boards[] __initdata = {
|
||||
#define ZYNOS_BOARD(vi, bi, mt) { .vendor_id = (vi), .board_id = (bi), \
|
||||
.mach_type = (mt) }
|
||||
|
||||
#define ZYXEL_BOARD(bi, mt) ZYNOS_BOARD(ZYNOS_VENDOR_ID_ZYXEL, bi, mt)
|
||||
#define DLINK_BOARD(bi, mt) ZYNOS_BOARD(ZYNOS_VENDOR_ID_DLINK, bi, mt)
|
||||
#define LUCENT_BOARD(bi, mt) ZYNOS_BOARD(ZYNOS_VENDOR_ID_LUCENT, bi, mt)
|
||||
ZYXEL_BOARD(ZYNOS_BOARD_HS100, MACH_ADM5120_HS100),
|
||||
ZYXEL_BOARD(ZYNOS_BOARD_P334, MACH_ADM5120_P334),
|
||||
ZYXEL_BOARD(ZYNOS_BOARD_P334U, MACH_ADM5120_P334U),
|
||||
ZYXEL_BOARD(ZYNOS_BOARD_P334W, MACH_ADM5120_P334W),
|
||||
ZYXEL_BOARD(ZYNOS_BOARD_P334WH, MACH_ADM5120_P334WH),
|
||||
ZYXEL_BOARD(ZYNOS_BOARD_P334WHD, MACH_ADM5120_P334WHD),
|
||||
ZYXEL_BOARD(ZYNOS_BOARD_P334WT, MACH_ADM5120_P334WT),
|
||||
ZYXEL_BOARD(ZYNOS_BOARD_P335, MACH_ADM5120_P335),
|
||||
ZYXEL_BOARD(ZYNOS_BOARD_P335PLUS, MACH_ADM5120_P335PLUS),
|
||||
ZYXEL_BOARD(ZYNOS_BOARD_P335U, MACH_ADM5120_P335U)
|
||||
};
|
||||
|
||||
static unsigned long __init detect_machtype_bootbase(void)
|
||||
{
|
||||
unsigned long ret;
|
||||
int i;
|
||||
|
||||
ret = MACH_ADM5120_GENERIC;
|
||||
for (i=0; i<ARRAY_SIZE(zynos_boards); i++) {
|
||||
if (zynos_boards[i].vendor_id == bootbase_info.vendor_id &&
|
||||
zynos_boards[i].board_id == bootbase_info.board_id) {
|
||||
ret = zynos_boards[i].mach_type;
|
||||
break;
|
||||
}
|
||||
}
|
||||
@@ -98,29 +162,108 @@ char *prom_getenv(char *envname)
|
||||
return ret;
|
||||
}
|
||||
|
||||
extern char _image_cmdline;
|
||||
/*
|
||||
* initialize the prom module.
|
||||
*/
|
||||
void __init prom_init(void)
|
||||
{
|
||||
char *cmd;
|
||||
static struct {
|
||||
unsigned long mach_type;
|
||||
u16 vid;
|
||||
u16 did;
|
||||
u16 svid;
|
||||
u16 sdid;
|
||||
} mylo_boards[] __initdata = {
|
||||
#define MYLO_BOARD(v,d,sv,sd,mt) { .vid = (v), .did = (d), .svid = (sv), \
|
||||
.sdid = (sd), .mach_type = (mt) }
|
||||
#define COMPEX_BOARD(d,mt) MYLO_BOARD(VENID_COMPEX,(d),VENID_COMPEX,(d),(mt))
|
||||
|
||||
if ((fw_arg2 & 3) == 0) {
|
||||
prom_envp = (char **)fw_arg2;
|
||||
COMPEX_BOARD(DEVID_COMPEX_NP27G, MACH_ADM5120_NP27G),
|
||||
COMPEX_BOARD(DEVID_COMPEX_NP28G, MACH_ADM5120_NP28G),
|
||||
COMPEX_BOARD(DEVID_COMPEX_NP28GHS, MACH_ADM5120_NP28GHS),
|
||||
COMPEX_BOARD(DEVID_COMPEX_WP54G, MACH_ADM5120_WP54G),
|
||||
COMPEX_BOARD(DEVID_COMPEX_WP54Gv1C, MACH_ADM5120_WP54Gv1C),
|
||||
COMPEX_BOARD(DEVID_COMPEX_WP54AG, MACH_ADM5120_WP54AG),
|
||||
COMPEX_BOARD(DEVID_COMPEX_WPP54G, MACH_ADM5120_WPP54G),
|
||||
COMPEX_BOARD(DEVID_COMPEX_WPP54AG, MACH_ADM5120_WPP54AG),
|
||||
};
|
||||
|
||||
static unsigned long __init detect_machtype_myloader(void)
|
||||
{
|
||||
unsigned long ret;
|
||||
int i;
|
||||
|
||||
ret = MACH_ADM5120_GENERIC;
|
||||
for (i=0; i<ARRAY_SIZE(mylo_boards); i++) {
|
||||
if (mylo_boards[i].vid == myloader_info.vid &&
|
||||
mylo_boards[i].did == myloader_info.did &&
|
||||
mylo_boards[i].svid == myloader_info.svid &&
|
||||
mylo_boards[i].sdid == myloader_info.sdid) {
|
||||
ret = mylo_boards[i].mach_type;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
adm5120_info_init();
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* you should these macros defined in include/asm/bootinfo.h */
|
||||
mips_machgroup = MACH_GROUP_ADM5120;
|
||||
mips_machtype = adm5120_board.mach_type;
|
||||
static void __init prom_detect_machtype(void)
|
||||
{
|
||||
if (bootbase_present()) {
|
||||
adm5120_prom_type = ADM5120_PROM_BOOTBASE;
|
||||
mips_machtype = detect_machtype_bootbase();
|
||||
return;
|
||||
}
|
||||
|
||||
if (cfe_present()) {
|
||||
adm5120_prom_type = ADM5120_PROM_CFE;
|
||||
mips_machtype = detect_machtype_cfe();
|
||||
return;
|
||||
}
|
||||
|
||||
if (myloader_present()) {
|
||||
adm5120_prom_type = ADM5120_PROM_MYLOADER;
|
||||
mips_machtype = detect_machtype_myloader();
|
||||
return;
|
||||
}
|
||||
|
||||
if (routerboot_present()) {
|
||||
adm5120_prom_type = ADM5120_PROM_ROUTERBOOT;
|
||||
mips_machtype = detect_machtype_routerboot();
|
||||
return;
|
||||
}
|
||||
|
||||
adm5120_prom_type = ADM5120_PROM_GENERIC;
|
||||
mips_machtype = detect_machtype_generic();
|
||||
}
|
||||
|
||||
/* TODO: this is an ugly hack for RouterBOARDS */
|
||||
extern char _image_cmdline;
|
||||
static void __init prom_init_cmdline(void)
|
||||
{
|
||||
char *cmd;
|
||||
|
||||
/* init command line, register a default kernel command line */
|
||||
cmd = &_image_cmdline + 8;
|
||||
if( strlen(cmd) > 0) strcpy( &(arcs_cmdline[0]), cmd);
|
||||
else strcpy(&(arcs_cmdline[0]), CONFIG_CMDLINE);
|
||||
|
||||
/* init memory map */
|
||||
prom_meminit();
|
||||
}
|
||||
|
||||
#define UART_READ(r) *(volatile u32 *)(KSEG1ADDR(ADM5120_UART0_BASE)+(r))
|
||||
#define UART_WRITE(r,v) *(volatile u32 *)(KSEG1ADDR(ADM5120_UART0_BASE)+(r))=(v)
|
||||
|
||||
void __init prom_putchar(char ch)
|
||||
{
|
||||
while ((UART_READ(UART_REG_FLAG) & UART_FLAG_TXFE) == 0);
|
||||
UART_WRITE(UART_REG_DATA, ch);
|
||||
while ((UART_READ(UART_REG_FLAG) & UART_FLAG_TXFE) == 0);
|
||||
}
|
||||
|
||||
void __init prom_init(void)
|
||||
{
|
||||
mips_machgroup = MACH_GROUP_ADM5120;
|
||||
prom_detect_machtype();
|
||||
|
||||
prom_init_cmdline();
|
||||
}
|
||||
|
||||
void __init prom_free_prom_memory(void)
|
||||
{
|
||||
/* We do not have to prom memory to free */
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user