[PATCH] m68k pt_regs fixes
[linux-2.6.git] / arch / m68k / mvme147 / config.c
1 /*
2  *  arch/m68k/mvme147/config.c
3  *
4  *  Copyright (C) 1996 Dave Frascone [chaos@mindspring.com]
5  *  Cloned from        Richard Hirst [richard@sleepie.demon.co.uk]
6  *
7  * Based on:
8  *
9  *  Copyright (C) 1993 Hamish Macdonald
10  *
11  * This file is subject to the terms and conditions of the GNU General Public
12  * License.  See the file README.legal in the main directory of this archive
13  * for more details.
14  */
15
16 #include <linux/types.h>
17 #include <linux/kernel.h>
18 #include <linux/mm.h>
19 #include <linux/tty.h>
20 #include <linux/console.h>
21 #include <linux/linkage.h>
22 #include <linux/init.h>
23 #include <linux/major.h>
24 #include <linux/genhd.h>
25 #include <linux/rtc.h>
26 #include <linux/interrupt.h>
27
28 #include <asm/bootinfo.h>
29 #include <asm/system.h>
30 #include <asm/pgtable.h>
31 #include <asm/setup.h>
32 #include <asm/irq.h>
33 #include <asm/traps.h>
34 #include <asm/rtc.h>
35 #include <asm/machdep.h>
36 #include <asm/mvme147hw.h>
37
38
39 static void mvme147_get_model(char *model);
40 static int  mvme147_get_hardware_list(char *buffer);
41 extern void mvme147_sched_init(irqreturn_t (*handler)(int, void *));
42 extern unsigned long mvme147_gettimeoffset (void);
43 extern int mvme147_hwclk (int, struct rtc_time *);
44 extern int mvme147_set_clock_mmss (unsigned long);
45 extern void mvme147_reset (void);
46 extern void mvme147_waitbut(void);
47
48
49 static int bcd2int (unsigned char b);
50
51 /* Save tick handler routine pointer, will point to do_timer() in
52  * kernel/sched.c, called via mvme147_process_int() */
53
54 irqreturn_t (*tick_handler)(int, void *);
55
56
57 int mvme147_parse_bootinfo(const struct bi_record *bi)
58 {
59         if (bi->tag == BI_VME_TYPE || bi->tag == BI_VME_BRDINFO)
60                 return 0;
61         else
62                 return 1;
63 }
64
65 void mvme147_reset(void)
66 {
67         printk ("\r\n\nCalled mvme147_reset\r\n");
68         m147_pcc->watchdog = 0x0a;      /* Clear timer */
69         m147_pcc->watchdog = 0xa5;      /* Enable watchdog - 100ms to reset */
70         while (1)
71                 ;
72 }
73
74 static void mvme147_get_model(char *model)
75 {
76         sprintf(model, "Motorola MVME147");
77 }
78
79
80 static int mvme147_get_hardware_list(char *buffer)
81 {
82         *buffer = '\0';
83
84         return 0;
85 }
86
87 /*
88  * This function is called during kernel startup to initialize
89  * the mvme147 IRQ handling routines.
90  */
91
92 void mvme147_init_IRQ(void)
93 {
94         m68k_setup_user_interrupt(VEC_USER, 192, NULL);
95 }
96
97 void __init config_mvme147(void)
98 {
99         mach_max_dma_address    = 0x01000000;
100         mach_sched_init         = mvme147_sched_init;
101         mach_init_IRQ           = mvme147_init_IRQ;
102         mach_gettimeoffset      = mvme147_gettimeoffset;
103         mach_hwclk              = mvme147_hwclk;
104         mach_set_clock_mmss     = mvme147_set_clock_mmss;
105         mach_reset              = mvme147_reset;
106         mach_get_model          = mvme147_get_model;
107         mach_get_hardware_list  = mvme147_get_hardware_list;
108
109         /* Board type is only set by newer versions of vmelilo/tftplilo */
110         if (!vme_brdtype)
111                 vme_brdtype = VME_TYPE_MVME147;
112 }
113
114
115 /* Using pcc tick timer 1 */
116
117 static irqreturn_t mvme147_timer_int (int irq, void *dev_id)
118 {
119         m147_pcc->t1_int_cntrl = PCC_TIMER_INT_CLR;
120         m147_pcc->t1_int_cntrl = PCC_INT_ENAB|PCC_LEVEL_TIMER1;
121         return tick_handler(irq, dev_id);
122 }
123
124
125 void mvme147_sched_init (irqreturn_t (*timer_routine)(int, void *))
126 {
127         tick_handler = timer_routine;
128         request_irq (PCC_IRQ_TIMER1, mvme147_timer_int,
129                 IRQ_FLG_REPLACE, "timer 1", NULL);
130
131         /* Init the clock with a value */
132         /* our clock goes off every 6.25us */
133         m147_pcc->t1_preload = PCC_TIMER_PRELOAD;
134         m147_pcc->t1_cntrl = 0x0;       /* clear timer */
135         m147_pcc->t1_cntrl = 0x3;       /* start timer */
136         m147_pcc->t1_int_cntrl = PCC_TIMER_INT_CLR;  /* clear pending ints */
137         m147_pcc->t1_int_cntrl = PCC_INT_ENAB|PCC_LEVEL_TIMER1;
138 }
139
140 /* This is always executed with interrupts disabled.  */
141 /* XXX There are race hazards in this code XXX */
142 unsigned long mvme147_gettimeoffset (void)
143 {
144         volatile unsigned short *cp = (volatile unsigned short *)0xfffe1012;
145         unsigned short n;
146
147         n = *cp;
148         while (n != *cp)
149                 n = *cp;
150
151         n -= PCC_TIMER_PRELOAD;
152         return (unsigned long)n * 25 / 4;
153 }
154
155 static int bcd2int (unsigned char b)
156 {
157         return ((b>>4)*10 + (b&15));
158 }
159
160 int mvme147_hwclk(int op, struct rtc_time *t)
161 {
162 #warning check me!
163         if (!op) {
164                 m147_rtc->ctrl = RTC_READ;
165                 t->tm_year = bcd2int (m147_rtc->bcd_year);
166                 t->tm_mon  = bcd2int (m147_rtc->bcd_mth);
167                 t->tm_mday = bcd2int (m147_rtc->bcd_dom);
168                 t->tm_hour = bcd2int (m147_rtc->bcd_hr);
169                 t->tm_min  = bcd2int (m147_rtc->bcd_min);
170                 t->tm_sec  = bcd2int (m147_rtc->bcd_sec);
171                 m147_rtc->ctrl = 0;
172         }
173         return 0;
174 }
175
176 int mvme147_set_clock_mmss (unsigned long nowtime)
177 {
178         return 0;
179 }
180
181 /*-------------------  Serial console stuff ------------------------*/
182
183 static void scc_delay (void)
184 {
185         int n;
186         volatile int trash;
187
188         for (n = 0; n < 20; n++)
189                 trash = n;
190 }
191
192 static void scc_write (char ch)
193 {
194         volatile char *p = (volatile char *)M147_SCC_A_ADDR;
195
196         do {
197                 scc_delay();
198         }
199         while (!(*p & 4));
200         scc_delay();
201         *p = 8;
202         scc_delay();
203         *p = ch;
204 }
205
206
207 void m147_scc_write (struct console *co, const char *str, unsigned count)
208 {
209         unsigned long flags;
210
211         local_irq_save(flags);
212
213         while (count--)
214         {
215                 if (*str == '\n')
216                         scc_write ('\r');
217                 scc_write (*str++);
218         }
219         local_irq_restore(flags);
220 }
221
222 void mvme147_init_console_port (struct console *co, int cflag)
223 {
224         co->write    = m147_scc_write;
225 }