xref: /OK3568_Linux_fs/kernel/arch/m68k/mvme16x/config.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  *  arch/m68k/mvme16x/config.c
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  *  Copyright (C) 1995 Richard Hirst [richard@sleepie.demon.co.uk]
5*4882a593Smuzhiyun  *
6*4882a593Smuzhiyun  * Based on:
7*4882a593Smuzhiyun  *
8*4882a593Smuzhiyun  *  linux/amiga/config.c
9*4882a593Smuzhiyun  *
10*4882a593Smuzhiyun  *  Copyright (C) 1993 Hamish Macdonald
11*4882a593Smuzhiyun  *
12*4882a593Smuzhiyun  * This file is subject to the terms and conditions of the GNU General Public
13*4882a593Smuzhiyun  * License.  See the file README.legal in the main directory of this archive
14*4882a593Smuzhiyun  * for more details.
15*4882a593Smuzhiyun  */
16*4882a593Smuzhiyun 
17*4882a593Smuzhiyun #include <linux/types.h>
18*4882a593Smuzhiyun #include <linux/kernel.h>
19*4882a593Smuzhiyun #include <linux/mm.h>
20*4882a593Smuzhiyun #include <linux/seq_file.h>
21*4882a593Smuzhiyun #include <linux/tty.h>
22*4882a593Smuzhiyun #include <linux/clocksource.h>
23*4882a593Smuzhiyun #include <linux/console.h>
24*4882a593Smuzhiyun #include <linux/linkage.h>
25*4882a593Smuzhiyun #include <linux/init.h>
26*4882a593Smuzhiyun #include <linux/major.h>
27*4882a593Smuzhiyun #include <linux/genhd.h>
28*4882a593Smuzhiyun #include <linux/rtc.h>
29*4882a593Smuzhiyun #include <linux/interrupt.h>
30*4882a593Smuzhiyun #include <linux/module.h>
31*4882a593Smuzhiyun 
32*4882a593Smuzhiyun #include <asm/bootinfo.h>
33*4882a593Smuzhiyun #include <asm/bootinfo-vme.h>
34*4882a593Smuzhiyun #include <asm/byteorder.h>
35*4882a593Smuzhiyun #include <asm/setup.h>
36*4882a593Smuzhiyun #include <asm/irq.h>
37*4882a593Smuzhiyun #include <asm/traps.h>
38*4882a593Smuzhiyun #include <asm/machdep.h>
39*4882a593Smuzhiyun #include <asm/mvme16xhw.h>
40*4882a593Smuzhiyun 
41*4882a593Smuzhiyun extern t_bdid mvme_bdid;
42*4882a593Smuzhiyun 
43*4882a593Smuzhiyun static MK48T08ptr_t volatile rtc = (MK48T08ptr_t)MVME_RTC_BASE;
44*4882a593Smuzhiyun 
45*4882a593Smuzhiyun static void mvme16x_get_model(char *model);
46*4882a593Smuzhiyun extern void mvme16x_sched_init(irq_handler_t handler);
47*4882a593Smuzhiyun extern int mvme16x_hwclk (int, struct rtc_time *);
48*4882a593Smuzhiyun extern void mvme16x_reset (void);
49*4882a593Smuzhiyun 
50*4882a593Smuzhiyun int bcd2int (unsigned char b);
51*4882a593Smuzhiyun 
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun unsigned short mvme16x_config;
54*4882a593Smuzhiyun EXPORT_SYMBOL(mvme16x_config);
55*4882a593Smuzhiyun 
56*4882a593Smuzhiyun 
mvme16x_parse_bootinfo(const struct bi_record * bi)57*4882a593Smuzhiyun int __init mvme16x_parse_bootinfo(const struct bi_record *bi)
58*4882a593Smuzhiyun {
59*4882a593Smuzhiyun 	uint16_t tag = be16_to_cpu(bi->tag);
60*4882a593Smuzhiyun 	if (tag == BI_VME_TYPE || tag == BI_VME_BRDINFO)
61*4882a593Smuzhiyun 		return 0;
62*4882a593Smuzhiyun 	else
63*4882a593Smuzhiyun 		return 1;
64*4882a593Smuzhiyun }
65*4882a593Smuzhiyun 
mvme16x_reset(void)66*4882a593Smuzhiyun void mvme16x_reset(void)
67*4882a593Smuzhiyun {
68*4882a593Smuzhiyun 	pr_info("\r\n\nCalled mvme16x_reset\r\n"
69*4882a593Smuzhiyun 		"\r\r\r\r\r\r\r\r\r\r\r\r\r\r\r\r\r\r");
70*4882a593Smuzhiyun 	/* The string of returns is to delay the reset until the whole
71*4882a593Smuzhiyun 	 * message is output.  Assert reset bit in GCSR */
72*4882a593Smuzhiyun 	*(volatile char *)0xfff40107 = 0x80;
73*4882a593Smuzhiyun }
74*4882a593Smuzhiyun 
mvme16x_get_model(char * model)75*4882a593Smuzhiyun static void mvme16x_get_model(char *model)
76*4882a593Smuzhiyun {
77*4882a593Smuzhiyun     p_bdid p = &mvme_bdid;
78*4882a593Smuzhiyun     char suf[4];
79*4882a593Smuzhiyun 
80*4882a593Smuzhiyun     suf[1] = p->brdsuffix[0];
81*4882a593Smuzhiyun     suf[2] = p->brdsuffix[1];
82*4882a593Smuzhiyun     suf[3] = '\0';
83*4882a593Smuzhiyun     suf[0] = suf[1] ? '-' : '\0';
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun     sprintf(model, "Motorola MVME%x%s", be16_to_cpu(p->brdno), suf);
86*4882a593Smuzhiyun }
87*4882a593Smuzhiyun 
88*4882a593Smuzhiyun 
mvme16x_get_hardware_list(struct seq_file * m)89*4882a593Smuzhiyun static void mvme16x_get_hardware_list(struct seq_file *m)
90*4882a593Smuzhiyun {
91*4882a593Smuzhiyun     uint16_t brdno = be16_to_cpu(mvme_bdid.brdno);
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun     if (brdno == 0x0162 || brdno == 0x0172)
94*4882a593Smuzhiyun     {
95*4882a593Smuzhiyun 	unsigned char rev = *(unsigned char *)MVME162_VERSION_REG;
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun 	seq_printf (m, "VMEchip2        %spresent\n",
98*4882a593Smuzhiyun 			rev & MVME16x_CONFIG_NO_VMECHIP2 ? "NOT " : "");
99*4882a593Smuzhiyun 	seq_printf (m, "SCSI interface  %spresent\n",
100*4882a593Smuzhiyun 			rev & MVME16x_CONFIG_NO_SCSICHIP ? "NOT " : "");
101*4882a593Smuzhiyun 	seq_printf (m, "Ethernet i/f    %spresent\n",
102*4882a593Smuzhiyun 			rev & MVME16x_CONFIG_NO_ETHERNET ? "NOT " : "");
103*4882a593Smuzhiyun     }
104*4882a593Smuzhiyun }
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun /*
107*4882a593Smuzhiyun  * This function is called during kernel startup to initialize
108*4882a593Smuzhiyun  * the mvme16x IRQ handling routines.  Should probably ensure
109*4882a593Smuzhiyun  * that the base vectors for the VMEChip2 and PCCChip2 are valid.
110*4882a593Smuzhiyun  */
111*4882a593Smuzhiyun 
mvme16x_init_IRQ(void)112*4882a593Smuzhiyun static void __init mvme16x_init_IRQ (void)
113*4882a593Smuzhiyun {
114*4882a593Smuzhiyun 	m68k_setup_user_interrupt(VEC_USER, 192);
115*4882a593Smuzhiyun }
116*4882a593Smuzhiyun 
117*4882a593Smuzhiyun #define PCC2CHIP   (0xfff42000)
118*4882a593Smuzhiyun #define PCCSCCMICR (PCC2CHIP + 0x1d)
119*4882a593Smuzhiyun #define PCCSCCTICR (PCC2CHIP + 0x1e)
120*4882a593Smuzhiyun #define PCCSCCRICR (PCC2CHIP + 0x1f)
121*4882a593Smuzhiyun #define PCCTPIACKR (PCC2CHIP + 0x25)
122*4882a593Smuzhiyun 
123*4882a593Smuzhiyun #ifdef CONFIG_EARLY_PRINTK
124*4882a593Smuzhiyun 
125*4882a593Smuzhiyun /**** cd2401 registers ****/
126*4882a593Smuzhiyun #define CD2401_ADDR	(0xfff45000)
127*4882a593Smuzhiyun 
128*4882a593Smuzhiyun #define CyGFRCR         (0x81)
129*4882a593Smuzhiyun #define CyCCR		(0x13)
130*4882a593Smuzhiyun #define      CyCLR_CHAN		(0x40)
131*4882a593Smuzhiyun #define      CyINIT_CHAN	(0x20)
132*4882a593Smuzhiyun #define      CyCHIP_RESET	(0x10)
133*4882a593Smuzhiyun #define      CyENB_XMTR		(0x08)
134*4882a593Smuzhiyun #define      CyDIS_XMTR		(0x04)
135*4882a593Smuzhiyun #define      CyENB_RCVR		(0x02)
136*4882a593Smuzhiyun #define      CyDIS_RCVR		(0x01)
137*4882a593Smuzhiyun #define CyCAR		(0xee)
138*4882a593Smuzhiyun #define CyIER		(0x11)
139*4882a593Smuzhiyun #define      CyMdmCh		(0x80)
140*4882a593Smuzhiyun #define      CyRxExc		(0x20)
141*4882a593Smuzhiyun #define      CyRxData		(0x08)
142*4882a593Smuzhiyun #define      CyTxMpty		(0x02)
143*4882a593Smuzhiyun #define      CyTxRdy		(0x01)
144*4882a593Smuzhiyun #define CyLICR		(0x26)
145*4882a593Smuzhiyun #define CyRISR		(0x89)
146*4882a593Smuzhiyun #define      CyTIMEOUT		(0x80)
147*4882a593Smuzhiyun #define      CySPECHAR		(0x70)
148*4882a593Smuzhiyun #define      CyOVERRUN		(0x08)
149*4882a593Smuzhiyun #define      CyPARITY		(0x04)
150*4882a593Smuzhiyun #define      CyFRAME		(0x02)
151*4882a593Smuzhiyun #define      CyBREAK		(0x01)
152*4882a593Smuzhiyun #define CyREOIR		(0x84)
153*4882a593Smuzhiyun #define CyTEOIR		(0x85)
154*4882a593Smuzhiyun #define CyMEOIR		(0x86)
155*4882a593Smuzhiyun #define      CyNOTRANS		(0x08)
156*4882a593Smuzhiyun #define CyRFOC		(0x30)
157*4882a593Smuzhiyun #define CyRDR		(0xf8)
158*4882a593Smuzhiyun #define CyTDR		(0xf8)
159*4882a593Smuzhiyun #define CyMISR		(0x8b)
160*4882a593Smuzhiyun #define CyRISR		(0x89)
161*4882a593Smuzhiyun #define CyTISR		(0x8a)
162*4882a593Smuzhiyun #define CyMSVR1		(0xde)
163*4882a593Smuzhiyun #define CyMSVR2		(0xdf)
164*4882a593Smuzhiyun #define      CyDSR		(0x80)
165*4882a593Smuzhiyun #define      CyDCD		(0x40)
166*4882a593Smuzhiyun #define      CyCTS		(0x20)
167*4882a593Smuzhiyun #define      CyDTR		(0x02)
168*4882a593Smuzhiyun #define      CyRTS		(0x01)
169*4882a593Smuzhiyun #define CyRTPRL		(0x25)
170*4882a593Smuzhiyun #define CyRTPRH		(0x24)
171*4882a593Smuzhiyun #define CyCOR1		(0x10)
172*4882a593Smuzhiyun #define      CyPARITY_NONE	(0x00)
173*4882a593Smuzhiyun #define      CyPARITY_E		(0x40)
174*4882a593Smuzhiyun #define      CyPARITY_O		(0xC0)
175*4882a593Smuzhiyun #define      Cy_5_BITS		(0x04)
176*4882a593Smuzhiyun #define      Cy_6_BITS		(0x05)
177*4882a593Smuzhiyun #define      Cy_7_BITS		(0x06)
178*4882a593Smuzhiyun #define      Cy_8_BITS		(0x07)
179*4882a593Smuzhiyun #define CyCOR2		(0x17)
180*4882a593Smuzhiyun #define      CyETC		(0x20)
181*4882a593Smuzhiyun #define      CyCtsAE		(0x02)
182*4882a593Smuzhiyun #define CyCOR3		(0x16)
183*4882a593Smuzhiyun #define      Cy_1_STOP		(0x02)
184*4882a593Smuzhiyun #define      Cy_2_STOP		(0x04)
185*4882a593Smuzhiyun #define CyCOR4		(0x15)
186*4882a593Smuzhiyun #define      CyREC_FIFO		(0x0F)  /* Receive FIFO threshold */
187*4882a593Smuzhiyun #define CyCOR5		(0x14)
188*4882a593Smuzhiyun #define CyCOR6		(0x18)
189*4882a593Smuzhiyun #define CyCOR7		(0x07)
190*4882a593Smuzhiyun #define CyRBPR		(0xcb)
191*4882a593Smuzhiyun #define CyRCOR		(0xc8)
192*4882a593Smuzhiyun #define CyTBPR		(0xc3)
193*4882a593Smuzhiyun #define CyTCOR		(0xc0)
194*4882a593Smuzhiyun #define CySCHR1		(0x1f)
195*4882a593Smuzhiyun #define CySCHR2 	(0x1e)
196*4882a593Smuzhiyun #define CyTPR		(0xda)
197*4882a593Smuzhiyun #define CyPILR1		(0xe3)
198*4882a593Smuzhiyun #define CyPILR2		(0xe0)
199*4882a593Smuzhiyun #define CyPILR3		(0xe1)
200*4882a593Smuzhiyun #define CyCMR		(0x1b)
201*4882a593Smuzhiyun #define      CyASYNC		(0x02)
202*4882a593Smuzhiyun #define CyLICR          (0x26)
203*4882a593Smuzhiyun #define CyLIVR          (0x09)
204*4882a593Smuzhiyun #define CySCRL		(0x23)
205*4882a593Smuzhiyun #define CySCRH		(0x22)
206*4882a593Smuzhiyun #define CyTFTC		(0x80)
207*4882a593Smuzhiyun 
mvme16x_cons_write(struct console * co,const char * str,unsigned count)208*4882a593Smuzhiyun void mvme16x_cons_write(struct console *co, const char *str, unsigned count)
209*4882a593Smuzhiyun {
210*4882a593Smuzhiyun 	volatile unsigned char *base_addr = (u_char *)CD2401_ADDR;
211*4882a593Smuzhiyun 	volatile u_char sink;
212*4882a593Smuzhiyun 	u_char ier;
213*4882a593Smuzhiyun 	int port;
214*4882a593Smuzhiyun 	u_char do_lf = 0;
215*4882a593Smuzhiyun 	int i = 0;
216*4882a593Smuzhiyun 
217*4882a593Smuzhiyun 	/* Ensure transmitter is enabled! */
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun 	port = 0;
220*4882a593Smuzhiyun 	base_addr[CyCAR] = (u_char)port;
221*4882a593Smuzhiyun 	while (base_addr[CyCCR])
222*4882a593Smuzhiyun 		;
223*4882a593Smuzhiyun 	base_addr[CyCCR] = CyENB_XMTR;
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	ier = base_addr[CyIER];
226*4882a593Smuzhiyun 	base_addr[CyIER] = CyTxMpty;
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	while (1) {
229*4882a593Smuzhiyun 		if (in_8(PCCSCCTICR) & 0x20)
230*4882a593Smuzhiyun 		{
231*4882a593Smuzhiyun 			/* We have a Tx int. Acknowledge it */
232*4882a593Smuzhiyun 			sink = in_8(PCCTPIACKR);
233*4882a593Smuzhiyun 			if ((base_addr[CyLICR] >> 2) == port) {
234*4882a593Smuzhiyun 				if (i == count) {
235*4882a593Smuzhiyun 					/* Last char of string is now output */
236*4882a593Smuzhiyun 					base_addr[CyTEOIR] = CyNOTRANS;
237*4882a593Smuzhiyun 					break;
238*4882a593Smuzhiyun 				}
239*4882a593Smuzhiyun 				if (do_lf) {
240*4882a593Smuzhiyun 					base_addr[CyTDR] = '\n';
241*4882a593Smuzhiyun 					str++;
242*4882a593Smuzhiyun 					i++;
243*4882a593Smuzhiyun 					do_lf = 0;
244*4882a593Smuzhiyun 				}
245*4882a593Smuzhiyun 				else if (*str == '\n') {
246*4882a593Smuzhiyun 					base_addr[CyTDR] = '\r';
247*4882a593Smuzhiyun 					do_lf = 1;
248*4882a593Smuzhiyun 				}
249*4882a593Smuzhiyun 				else {
250*4882a593Smuzhiyun 					base_addr[CyTDR] = *str++;
251*4882a593Smuzhiyun 					i++;
252*4882a593Smuzhiyun 				}
253*4882a593Smuzhiyun 				base_addr[CyTEOIR] = 0;
254*4882a593Smuzhiyun 			}
255*4882a593Smuzhiyun 			else
256*4882a593Smuzhiyun 				base_addr[CyTEOIR] = CyNOTRANS;
257*4882a593Smuzhiyun 		}
258*4882a593Smuzhiyun 	}
259*4882a593Smuzhiyun 
260*4882a593Smuzhiyun 	base_addr[CyIER] = ier;
261*4882a593Smuzhiyun }
262*4882a593Smuzhiyun 
263*4882a593Smuzhiyun #endif
264*4882a593Smuzhiyun 
config_mvme16x(void)265*4882a593Smuzhiyun void __init config_mvme16x(void)
266*4882a593Smuzhiyun {
267*4882a593Smuzhiyun     p_bdid p = &mvme_bdid;
268*4882a593Smuzhiyun     char id[40];
269*4882a593Smuzhiyun     uint16_t brdno = be16_to_cpu(p->brdno);
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun     mach_max_dma_address = 0xffffffff;
272*4882a593Smuzhiyun     mach_sched_init      = mvme16x_sched_init;
273*4882a593Smuzhiyun     mach_init_IRQ        = mvme16x_init_IRQ;
274*4882a593Smuzhiyun     mach_hwclk           = mvme16x_hwclk;
275*4882a593Smuzhiyun     mach_reset		 = mvme16x_reset;
276*4882a593Smuzhiyun     mach_get_model       = mvme16x_get_model;
277*4882a593Smuzhiyun     mach_get_hardware_list = mvme16x_get_hardware_list;
278*4882a593Smuzhiyun 
279*4882a593Smuzhiyun     /* Report board revision */
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun     if (strncmp("BDID", p->bdid, 4))
282*4882a593Smuzhiyun     {
283*4882a593Smuzhiyun 	pr_crit("Bug call .BRD_ID returned garbage - giving up\n");
284*4882a593Smuzhiyun 	while (1)
285*4882a593Smuzhiyun 		;
286*4882a593Smuzhiyun     }
287*4882a593Smuzhiyun     /* Board type is only set by newer versions of vmelilo/tftplilo */
288*4882a593Smuzhiyun     if (vme_brdtype == 0)
289*4882a593Smuzhiyun 	vme_brdtype = brdno;
290*4882a593Smuzhiyun 
291*4882a593Smuzhiyun     mvme16x_get_model(id);
292*4882a593Smuzhiyun     pr_info("BRD_ID: %s   BUG %x.%x %02x/%02x/%02x\n", id, p->rev >> 4,
293*4882a593Smuzhiyun 	    p->rev & 0xf, p->yr, p->mth, p->day);
294*4882a593Smuzhiyun     if (brdno == 0x0162 || brdno == 0x172)
295*4882a593Smuzhiyun     {
296*4882a593Smuzhiyun 	unsigned char rev = *(unsigned char *)MVME162_VERSION_REG;
297*4882a593Smuzhiyun 
298*4882a593Smuzhiyun 	mvme16x_config = rev | MVME16x_CONFIG_GOT_SCCA;
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 	pr_info("MVME%x Hardware status:\n", brdno);
301*4882a593Smuzhiyun 	pr_info("    CPU Type           68%s040\n",
302*4882a593Smuzhiyun 		rev & MVME16x_CONFIG_GOT_FPU ? "" : "LC");
303*4882a593Smuzhiyun 	pr_info("    CPU clock          %dMHz\n",
304*4882a593Smuzhiyun 		rev & MVME16x_CONFIG_SPEED_32 ? 32 : 25);
305*4882a593Smuzhiyun 	pr_info("    VMEchip2           %spresent\n",
306*4882a593Smuzhiyun 		rev & MVME16x_CONFIG_NO_VMECHIP2 ? "NOT " : "");
307*4882a593Smuzhiyun 	pr_info("    SCSI interface     %spresent\n",
308*4882a593Smuzhiyun 		rev & MVME16x_CONFIG_NO_SCSICHIP ? "NOT " : "");
309*4882a593Smuzhiyun 	pr_info("    Ethernet interface %spresent\n",
310*4882a593Smuzhiyun 		rev & MVME16x_CONFIG_NO_ETHERNET ? "NOT " : "");
311*4882a593Smuzhiyun     }
312*4882a593Smuzhiyun     else
313*4882a593Smuzhiyun     {
314*4882a593Smuzhiyun 	mvme16x_config = MVME16x_CONFIG_GOT_LP | MVME16x_CONFIG_GOT_CD2401;
315*4882a593Smuzhiyun     }
316*4882a593Smuzhiyun }
317*4882a593Smuzhiyun 
mvme16x_abort_int(int irq,void * dev_id)318*4882a593Smuzhiyun static irqreturn_t mvme16x_abort_int (int irq, void *dev_id)
319*4882a593Smuzhiyun {
320*4882a593Smuzhiyun 	unsigned long *new = (unsigned long *)vectors;
321*4882a593Smuzhiyun 	unsigned long *old = (unsigned long *)0xffe00000;
322*4882a593Smuzhiyun 	volatile unsigned char uc, *ucp;
323*4882a593Smuzhiyun 	uint16_t brdno = be16_to_cpu(mvme_bdid.brdno);
324*4882a593Smuzhiyun 
325*4882a593Smuzhiyun 	if (brdno == 0x0162 || brdno == 0x172)
326*4882a593Smuzhiyun 	{
327*4882a593Smuzhiyun 		ucp = (volatile unsigned char *)0xfff42043;
328*4882a593Smuzhiyun 		uc = *ucp | 8;
329*4882a593Smuzhiyun 		*ucp = uc;
330*4882a593Smuzhiyun 	}
331*4882a593Smuzhiyun 	else
332*4882a593Smuzhiyun 	{
333*4882a593Smuzhiyun 		*(volatile unsigned long *)0xfff40074 = 0x40000000;
334*4882a593Smuzhiyun 	}
335*4882a593Smuzhiyun 	*(new+4) = *(old+4);		/* Illegal instruction */
336*4882a593Smuzhiyun 	*(new+9) = *(old+9);		/* Trace */
337*4882a593Smuzhiyun 	*(new+47) = *(old+47);		/* Trap #15 */
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 	if (brdno == 0x0162 || brdno == 0x172)
340*4882a593Smuzhiyun 		*(new+0x5e) = *(old+0x5e);	/* ABORT switch */
341*4882a593Smuzhiyun 	else
342*4882a593Smuzhiyun 		*(new+0x6e) = *(old+0x6e);	/* ABORT switch */
343*4882a593Smuzhiyun 	return IRQ_HANDLED;
344*4882a593Smuzhiyun }
345*4882a593Smuzhiyun 
346*4882a593Smuzhiyun static u64 mvme16x_read_clk(struct clocksource *cs);
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun static struct clocksource mvme16x_clk = {
349*4882a593Smuzhiyun 	.name   = "pcc",
350*4882a593Smuzhiyun 	.rating = 250,
351*4882a593Smuzhiyun 	.read   = mvme16x_read_clk,
352*4882a593Smuzhiyun 	.mask   = CLOCKSOURCE_MASK(32),
353*4882a593Smuzhiyun 	.flags  = CLOCK_SOURCE_IS_CONTINUOUS,
354*4882a593Smuzhiyun };
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun static u32 clk_total;
357*4882a593Smuzhiyun 
358*4882a593Smuzhiyun #define PCC_TIMER_CLOCK_FREQ 1000000
359*4882a593Smuzhiyun #define PCC_TIMER_CYCLES     (PCC_TIMER_CLOCK_FREQ / HZ)
360*4882a593Smuzhiyun 
361*4882a593Smuzhiyun #define PCCTCMP1             (PCC2CHIP + 0x04)
362*4882a593Smuzhiyun #define PCCTCNT1             (PCC2CHIP + 0x08)
363*4882a593Smuzhiyun #define PCCTOVR1             (PCC2CHIP + 0x17)
364*4882a593Smuzhiyun #define PCCTIC1              (PCC2CHIP + 0x1b)
365*4882a593Smuzhiyun 
366*4882a593Smuzhiyun #define PCCTOVR1_TIC_EN      0x01
367*4882a593Smuzhiyun #define PCCTOVR1_COC_EN      0x02
368*4882a593Smuzhiyun #define PCCTOVR1_OVR_CLR     0x04
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun #define PCCTIC1_INT_LEVEL    6
371*4882a593Smuzhiyun #define PCCTIC1_INT_CLR      0x08
372*4882a593Smuzhiyun #define PCCTIC1_INT_EN       0x10
373*4882a593Smuzhiyun 
mvme16x_timer_int(int irq,void * dev_id)374*4882a593Smuzhiyun static irqreturn_t mvme16x_timer_int (int irq, void *dev_id)
375*4882a593Smuzhiyun {
376*4882a593Smuzhiyun 	irq_handler_t timer_routine = dev_id;
377*4882a593Smuzhiyun 	unsigned long flags;
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun 	local_irq_save(flags);
380*4882a593Smuzhiyun 	out_8(PCCTOVR1, PCCTOVR1_OVR_CLR | PCCTOVR1_TIC_EN | PCCTOVR1_COC_EN);
381*4882a593Smuzhiyun 	out_8(PCCTIC1, PCCTIC1_INT_EN | PCCTIC1_INT_CLR | PCCTIC1_INT_LEVEL);
382*4882a593Smuzhiyun 	clk_total += PCC_TIMER_CYCLES;
383*4882a593Smuzhiyun 	timer_routine(0, NULL);
384*4882a593Smuzhiyun 	local_irq_restore(flags);
385*4882a593Smuzhiyun 
386*4882a593Smuzhiyun 	return IRQ_HANDLED;
387*4882a593Smuzhiyun }
388*4882a593Smuzhiyun 
mvme16x_sched_init(irq_handler_t timer_routine)389*4882a593Smuzhiyun void mvme16x_sched_init (irq_handler_t timer_routine)
390*4882a593Smuzhiyun {
391*4882a593Smuzhiyun     uint16_t brdno = be16_to_cpu(mvme_bdid.brdno);
392*4882a593Smuzhiyun     int irq;
393*4882a593Smuzhiyun 
394*4882a593Smuzhiyun     /* Using PCCchip2 or MC2 chip tick timer 1 */
395*4882a593Smuzhiyun     if (request_irq(MVME16x_IRQ_TIMER, mvme16x_timer_int, IRQF_TIMER, "timer",
396*4882a593Smuzhiyun                     timer_routine))
397*4882a593Smuzhiyun 	panic ("Couldn't register timer int");
398*4882a593Smuzhiyun 
399*4882a593Smuzhiyun     out_be32(PCCTCNT1, 0);
400*4882a593Smuzhiyun     out_be32(PCCTCMP1, PCC_TIMER_CYCLES);
401*4882a593Smuzhiyun     out_8(PCCTOVR1, PCCTOVR1_OVR_CLR | PCCTOVR1_TIC_EN | PCCTOVR1_COC_EN);
402*4882a593Smuzhiyun     out_8(PCCTIC1, PCCTIC1_INT_EN | PCCTIC1_INT_CLR | PCCTIC1_INT_LEVEL);
403*4882a593Smuzhiyun 
404*4882a593Smuzhiyun     clocksource_register_hz(&mvme16x_clk, PCC_TIMER_CLOCK_FREQ);
405*4882a593Smuzhiyun 
406*4882a593Smuzhiyun     if (brdno == 0x0162 || brdno == 0x172)
407*4882a593Smuzhiyun 	irq = MVME162_IRQ_ABORT;
408*4882a593Smuzhiyun     else
409*4882a593Smuzhiyun         irq = MVME167_IRQ_ABORT;
410*4882a593Smuzhiyun     if (request_irq(irq, mvme16x_abort_int, 0,
411*4882a593Smuzhiyun 				"abort", mvme16x_abort_int))
412*4882a593Smuzhiyun 	panic ("Couldn't register abort int");
413*4882a593Smuzhiyun }
414*4882a593Smuzhiyun 
mvme16x_read_clk(struct clocksource * cs)415*4882a593Smuzhiyun static u64 mvme16x_read_clk(struct clocksource *cs)
416*4882a593Smuzhiyun {
417*4882a593Smuzhiyun 	unsigned long flags;
418*4882a593Smuzhiyun 	u8 overflow, tmp;
419*4882a593Smuzhiyun 	u32 ticks;
420*4882a593Smuzhiyun 
421*4882a593Smuzhiyun 	local_irq_save(flags);
422*4882a593Smuzhiyun 	tmp = in_8(PCCTOVR1) >> 4;
423*4882a593Smuzhiyun 	ticks = in_be32(PCCTCNT1);
424*4882a593Smuzhiyun 	overflow = in_8(PCCTOVR1) >> 4;
425*4882a593Smuzhiyun 	if (overflow != tmp)
426*4882a593Smuzhiyun 		ticks = in_be32(PCCTCNT1);
427*4882a593Smuzhiyun 	ticks += overflow * PCC_TIMER_CYCLES;
428*4882a593Smuzhiyun 	ticks += clk_total;
429*4882a593Smuzhiyun 	local_irq_restore(flags);
430*4882a593Smuzhiyun 
431*4882a593Smuzhiyun 	return ticks;
432*4882a593Smuzhiyun }
433*4882a593Smuzhiyun 
bcd2int(unsigned char b)434*4882a593Smuzhiyun int bcd2int (unsigned char b)
435*4882a593Smuzhiyun {
436*4882a593Smuzhiyun 	return ((b>>4)*10 + (b&15));
437*4882a593Smuzhiyun }
438*4882a593Smuzhiyun 
mvme16x_hwclk(int op,struct rtc_time * t)439*4882a593Smuzhiyun int mvme16x_hwclk(int op, struct rtc_time *t)
440*4882a593Smuzhiyun {
441*4882a593Smuzhiyun #warning check me!
442*4882a593Smuzhiyun 	if (!op) {
443*4882a593Smuzhiyun 		rtc->ctrl = RTC_READ;
444*4882a593Smuzhiyun 		t->tm_year = bcd2int (rtc->bcd_year);
445*4882a593Smuzhiyun 		t->tm_mon  = bcd2int(rtc->bcd_mth) - 1;
446*4882a593Smuzhiyun 		t->tm_mday = bcd2int (rtc->bcd_dom);
447*4882a593Smuzhiyun 		t->tm_hour = bcd2int (rtc->bcd_hr);
448*4882a593Smuzhiyun 		t->tm_min  = bcd2int (rtc->bcd_min);
449*4882a593Smuzhiyun 		t->tm_sec  = bcd2int (rtc->bcd_sec);
450*4882a593Smuzhiyun 		rtc->ctrl = 0;
451*4882a593Smuzhiyun 		if (t->tm_year < 70)
452*4882a593Smuzhiyun 			t->tm_year += 100;
453*4882a593Smuzhiyun 	}
454*4882a593Smuzhiyun 	return 0;
455*4882a593Smuzhiyun }
456