target/linux/adm5120-2.6/files/arch/mips/adm5120/prom.c

   1 /*****************************************************************************
   2  * Carsten Langgaard, carstenl@mips.com
   3  * Copyright (C) 1999,2000 MIPS Technologies, Inc.  All rights reserved.
   4  * Copyright (C) 2003 ADMtek Incorporated.
   5  *      daniell@admtek.com.tw
   6  * Copyright (C) 2007 OpenWrt.org
   7  *
   8  *  This program is free software; you can distribute it and/or modify it
   9  *  under the terms of the GNU General Public License (Version 2) as
  10  *  published by the Free Software Foundation.
  11  *
  12  *  This program is distributed in the hope it will be useful, but WITHOUT
  13  *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  14  *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  15  *  for more details.
  16  *
  17  *  You should have received a copy of the GNU General Public License along
  18  *  with this program; if not, write to the Free Software Foundation, Inc.,
  19  *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
  20  *
  21  *****************************************************************************/
  22
  23 #include <linux/init.h>
  24 #include <linux/autoconf.h>
  25 #include <linux/kernel.h>
  26 #include <linux/string.h>
  27 #include <linux/mm.h>
  28 #include <linux/bootmem.h>
  29
  30 #include <asm/bootinfo.h>
  31 #include <asm/addrspace.h>
  32
  33 #include <asm/mach-adm5120/adm5120_info.h>
  34
  35 static char **prom_envp;
  36
  37 void setup_prom_printf(int);
  38 void prom_printf(char *, ...);
  39 void prom_meminit(void);
  40
  41
  42 #define READCSR(r)      *(volatile unsigned long *)(0xB2600000+(r))
  43 #define WRITECSR(r,v)   *(volatile unsigned long *)(0xB2600000+(r)) = v
  44
  45 #define UART_DR_REG         0x00
  46 #define UART_FR_REG         0x18
  47 #define UART_TX_FIFO_FULL   0x20
  48
  49 int putPromChar(char c)
  50 {
  51         WRITECSR(UART_DR_REG, c);
  52         while ( (READCSR(UART_FR_REG) & UART_TX_FIFO_FULL) );
  53         return 0;
  54 }
  55
  56 /*
  57  * Ugly prom_printf used for debugging
  58  */
  59
  60 void prom_printf(char *fmt, ...)
  61 {
  62         va_list args;
  63         int l;
  64         char *p, *buf_end;
  65         char buf[1024];
  66
  67         va_start(args, fmt);
  68         l = vsprintf(buf, fmt, args); /* hopefully i < sizeof(buf) */
  69         va_end(args);
  70
  71         buf_end = buf + l;
  72
  73         for (p = buf; p < buf_end; p++) {
  74                 /* Crude cr/nl handling is better than none */
  75                 if (*p == '\n')
  76                         putPromChar('\r');
  77                 putPromChar(*p);
  78         }
  79 }
  80
  81 char *prom_getenv(char *envname)
  82 {
  83         char **env;
  84         char *ret;
  85
  86         ret = NULL;
  87
  88         if (prom_envp== NULL)
  89                 return NULL;
  90
  91         for (env = prom_envp; *env != NULL; env++) {
  92                 if (strcmp(envname, *env++) == 0) {
  93                         ret = *env;
  94                         break;
  95                 }
  96         }
  97
  98         return ret;
  99 }
 100
 101 extern char _image_cmdline;
 102 /*
 103  * initialize the prom module.
 104  */
 105 void __init prom_init(void)
 106 {
 107         char *cmd;
 108
 109         prom_envp = (char **)fw_arg2;
 110
 111         adm5120_info_init();
 112
 113         /* you should these macros defined in include/asm/bootinfo.h */
 114         mips_machgroup = MACH_GROUP_ADM5120;
 115         mips_machtype = adm5120_board.mach_type;
 116
 117         /* init command line, register a default kernel command line */
 118         cmd = &_image_cmdline + 8;
 119         if( strlen(cmd) > 0) strcpy( &(arcs_cmdline[0]), cmd);
 120                 else strcpy(&(arcs_cmdline[0]), CONFIG_CMDLINE);
 121
 122         /* init memory map */
 123         prom_meminit();
 124 }