[MIPS] Deforest the function pointer jungle in the time code.
[linux-2.6.git] / arch / mips / sgi-ip32 / ip32-setup.c
1 /*
2  * IP32 basic setup
3  *
4  * This file is subject to the terms and conditions of the GNU General Public
5  * License.  See the file "COPYING" in the main directory of this archive
6  * for more details.
7  *
8  * Copyright (C) 2000 Harald Koerfgen
9  * Copyright (C) 2002, 2003, 2005 Ilya A. Volynets
10  * Copyright (C) 2006 Ralf Baechle <ralf@linux-mips.org>
11  */
12 #include <linux/console.h>
13 #include <linux/init.h>
14 #include <linux/interrupt.h>
15 #include <linux/mc146818rtc.h>
16 #include <linux/param.h>
17 #include <linux/sched.h>
18
19 #include <asm/bootinfo.h>
20 #include <asm/mc146818-time.h>
21 #include <asm/mipsregs.h>
22 #include <asm/mmu_context.h>
23 #include <asm/sgialib.h>
24 #include <asm/time.h>
25 #include <asm/traps.h>
26 #include <asm/io.h>
27 #include <asm/ip32/crime.h>
28 #include <asm/ip32/mace.h>
29 #include <asm/ip32/ip32_ints.h>
30
31 extern void ip32_be_init(void);
32 extern void crime_init(void);
33
34 #ifdef CONFIG_SGI_O2MACE_ETH
35 /*
36  * This is taken care of in here 'cause they say using Arc later on is
37  * problematic
38  */
39 extern char o2meth_eaddr[8];
40 static inline unsigned char str2hexnum(unsigned char c)
41 {
42         if (c >= '0' && c <= '9')
43                 return c - '0';
44         if (c >= 'a' && c <= 'f')
45                 return c - 'a' + 10;
46         return 0; /* foo */
47 }
48
49 static inline void str2eaddr(unsigned char *ea, unsigned char *str)
50 {
51         int i;
52
53         for (i = 0; i < 6; i++) {
54                 unsigned char num;
55
56                 if(*str == ':')
57                         str++;
58                 num = str2hexnum(*str++) << 4;
59                 num |= (str2hexnum(*str++));
60                 ea[i] = num;
61         }
62 }
63 #endif
64
65 unsigned long read_persistent_clock(void)
66 {
67         return mc146818_get_cmos_time();
68 }
69
70 /* An arbitrary time; this can be decreased if reliability looks good */
71 #define WAIT_MS 10
72
73 void __init plat_time_init(void)
74 {
75         printk(KERN_INFO "Calibrating system timer... ");
76         write_c0_count(0);
77         crime->timer = 0;
78         while (crime->timer < CRIME_MASTER_FREQ * WAIT_MS / 1000) ;
79         mips_hpt_frequency = read_c0_count() * 1000 / WAIT_MS;
80         printk("%d MHz CPU detected\n", mips_hpt_frequency * 2 / 1000000);
81 }
82
83 void __init plat_timer_setup(struct irqaction *irq)
84 {
85         irq->handler = no_action;
86         setup_irq(IP32_R4K_TIMER_IRQ, irq);
87 }
88
89 void __init plat_mem_setup(void)
90 {
91         board_be_init = ip32_be_init;
92
93 #ifdef CONFIG_SGI_O2MACE_ETH
94         {
95                 char *mac = ArcGetEnvironmentVariable("eaddr");
96                 str2eaddr(o2meth_eaddr, mac);
97         }
98 #endif
99
100 #if defined(CONFIG_SERIAL_CORE_CONSOLE)
101         {
102                 char* con = ArcGetEnvironmentVariable("console");
103                 if (con && *con == 'd') {
104                         static char options[8];
105                         char *baud = ArcGetEnvironmentVariable("dbaud");
106                         if (baud)
107                                 strcpy(options, baud);
108                         add_preferred_console("ttyS", *(con + 1) == '2' ? 1 : 0,
109                                               baud ? options : NULL);
110                 }
111         }
112 #endif
113 }