1
2
3
4
5
6
7
8
9
10
11
12
13
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
39static void mvme147_get_model(char *model);
40extern void mvme147_sched_init(irq_handler_t handler);
41extern unsigned long mvme147_gettimeoffset (void);
42extern int mvme147_hwclk (int, struct rtc_time *);
43extern int mvme147_set_clock_mmss (unsigned long);
44extern void mvme147_reset (void);
45
46
47static int bcd2int (unsigned char b);
48
49
50
51
52irq_handler_t tick_handler;
53
54
55int mvme147_parse_bootinfo(const struct bi_record *bi)
56{
57 if (bi->tag == BI_VME_TYPE || bi->tag == BI_VME_BRDINFO)
58 return 0;
59 else
60 return 1;
61}
62
63void mvme147_reset(void)
64{
65 printk ("\r\n\nCalled mvme147_reset\r\n");
66 m147_pcc->watchdog = 0x0a;
67 m147_pcc->watchdog = 0xa5;
68 while (1)
69 ;
70}
71
72static void mvme147_get_model(char *model)
73{
74 sprintf(model, "Motorola MVME147");
75}
76
77
78
79
80
81
82void __init mvme147_init_IRQ(void)
83{
84 m68k_setup_user_interrupt(VEC_USER, 192);
85}
86
87void __init config_mvme147(void)
88{
89 mach_max_dma_address = 0x01000000;
90 mach_sched_init = mvme147_sched_init;
91 mach_init_IRQ = mvme147_init_IRQ;
92 mach_gettimeoffset = mvme147_gettimeoffset;
93 mach_hwclk = mvme147_hwclk;
94 mach_set_clock_mmss = mvme147_set_clock_mmss;
95 mach_reset = mvme147_reset;
96 mach_get_model = mvme147_get_model;
97
98
99 if (!vme_brdtype)
100 vme_brdtype = VME_TYPE_MVME147;
101}
102
103
104
105
106static irqreturn_t mvme147_timer_int (int irq, void *dev_id)
107{
108 m147_pcc->t1_int_cntrl = PCC_TIMER_INT_CLR;
109 m147_pcc->t1_int_cntrl = PCC_INT_ENAB|PCC_LEVEL_TIMER1;
110 return tick_handler(irq, dev_id);
111}
112
113
114void mvme147_sched_init (irq_handler_t timer_routine)
115{
116 tick_handler = timer_routine;
117 if (request_irq(PCC_IRQ_TIMER1, mvme147_timer_int, 0, "timer 1", NULL))
118 pr_err("Couldn't register timer interrupt\n");
119
120
121
122 m147_pcc->t1_preload = PCC_TIMER_PRELOAD;
123 m147_pcc->t1_cntrl = 0x0;
124 m147_pcc->t1_cntrl = 0x3;
125 m147_pcc->t1_int_cntrl = PCC_TIMER_INT_CLR;
126 m147_pcc->t1_int_cntrl = PCC_INT_ENAB|PCC_LEVEL_TIMER1;
127}
128
129
130
131unsigned long mvme147_gettimeoffset (void)
132{
133 volatile unsigned short *cp = (volatile unsigned short *)0xfffe1012;
134 unsigned short n;
135
136 n = *cp;
137 while (n != *cp)
138 n = *cp;
139
140 n -= PCC_TIMER_PRELOAD;
141 return (unsigned long)n * 25 / 4;
142}
143
144static int bcd2int (unsigned char b)
145{
146 return ((b>>4)*10 + (b&15));
147}
148
149int mvme147_hwclk(int op, struct rtc_time *t)
150{
151#warning check me!
152 if (!op) {
153 m147_rtc->ctrl = RTC_READ;
154 t->tm_year = bcd2int (m147_rtc->bcd_year);
155 t->tm_mon = bcd2int (m147_rtc->bcd_mth);
156 t->tm_mday = bcd2int (m147_rtc->bcd_dom);
157 t->tm_hour = bcd2int (m147_rtc->bcd_hr);
158 t->tm_min = bcd2int (m147_rtc->bcd_min);
159 t->tm_sec = bcd2int (m147_rtc->bcd_sec);
160 m147_rtc->ctrl = 0;
161 }
162 return 0;
163}
164
165int mvme147_set_clock_mmss (unsigned long nowtime)
166{
167 return 0;
168}
169
170
171
172static void scc_delay (void)
173{
174 int n;
175 volatile int trash;
176
177 for (n = 0; n < 20; n++)
178 trash = n;
179}
180
181static void scc_write (char ch)
182{
183 volatile char *p = (volatile char *)M147_SCC_A_ADDR;
184
185 do {
186 scc_delay();
187 }
188 while (!(*p & 4));
189 scc_delay();
190 *p = 8;
191 scc_delay();
192 *p = ch;
193}
194
195
196void m147_scc_write (struct console *co, const char *str, unsigned count)
197{
198 unsigned long flags;
199
200 local_irq_save(flags);
201
202 while (count--)
203 {
204 if (*str == '\n')
205 scc_write ('\r');
206 scc_write (*str++);
207 }
208 local_irq_restore(flags);
209}
210
211void mvme147_init_console_port (struct console *co, int cflag)
212{
213 co->write = m147_scc_write;
214}
215