Merge branch 'hwmon-for-linus' of git://jdelvare.pck.nerim.net/jdelvare-2.6
[pandora-kernel.git] / arch / sh / boards / mpc1211 / setup.c
1 /*
2  * linux/arch/sh/boards/mpc1211/setup.c
3  *
4  * Copyright (C) 2002  Saito.K & Jeanne,  Fujii.Y
5  *
6  */
7
8 #include <linux/init.h>
9 #include <linux/irq.h>
10 #include <linux/hdreg.h>
11 #include <linux/ide.h>
12 #include <linux/interrupt.h>
13 #include <linux/platform_device.h>
14 #include <asm/io.h>
15 #include <asm/machvec.h>
16 #include <asm/mpc1211/mpc1211.h>
17 #include <asm/mpc1211/pci.h>
18 #include <asm/mpc1211/m1543c.h>
19
20 /* ALI15X3 SMBus address offsets */
21 #define SMBHSTSTS   (0 + 0x3100)
22 #define SMBHSTCNT   (1 + 0x3100)
23 #define SMBHSTSTART (2 + 0x3100)
24 #define SMBHSTCMD   (7 + 0x3100)
25 #define SMBHSTADD   (3 + 0x3100)
26 #define SMBHSTDAT0  (4 + 0x3100)
27 #define SMBHSTDAT1  (5 + 0x3100)
28 #define SMBBLKDAT   (6 + 0x3100)
29
30 /* Other settings */
31 #define MAX_TIMEOUT 500         /* times 1/100 sec */
32
33 /* ALI15X3 command constants */
34 #define ALI15X3_ABORT      0x04
35 #define ALI15X3_T_OUT      0x08
36 #define ALI15X3_QUICK      0x00
37 #define ALI15X3_BYTE       0x10
38 #define ALI15X3_BYTE_DATA  0x20
39 #define ALI15X3_WORD_DATA  0x30
40 #define ALI15X3_BLOCK_DATA 0x40
41 #define ALI15X3_BLOCK_CLR  0x80
42
43 /* ALI15X3 status register bits */
44 #define ALI15X3_STS_IDLE        0x04
45 #define ALI15X3_STS_BUSY        0x08
46 #define ALI15X3_STS_DONE        0x10
47 #define ALI15X3_STS_DEV         0x20    /* device error */
48 #define ALI15X3_STS_COLL        0x40    /* collision or no response */
49 #define ALI15X3_STS_TERM        0x80    /* terminated by abort */
50 #define ALI15X3_STS_ERR         0xE0    /* all the bad error bits */
51
52 static void __init pci_write_config(unsigned long busNo,
53                                     unsigned long devNo,
54                                     unsigned long fncNo,
55                                     unsigned long cnfAdd,
56                                     unsigned long cnfData)
57 {
58         ctrl_outl((0x80000000 
59                 + ((busNo & 0xff) << 16) 
60                 + ((devNo & 0x1f) << 11) 
61                 + ((fncNo & 0x07) <<  8) 
62                 + (cnfAdd & 0xfc)), PCIPAR);
63
64         ctrl_outl(cnfData, PCIPDR);
65 }
66
67 /*
68   Initialize IRQ setting
69 */
70
71 static unsigned char m_irq_mask = 0xfb;
72 static unsigned char s_irq_mask = 0xff;
73
74 static void disable_mpc1211_irq(unsigned int irq)
75 {
76         if( irq < 8) {
77                 m_irq_mask |= (1 << irq);
78                 outb(m_irq_mask,I8259_M_MR);
79         } else {
80                 s_irq_mask |= (1 << (irq - 8));
81                 outb(s_irq_mask,I8259_S_MR);
82         }
83
84 }
85
86 static void enable_mpc1211_irq(unsigned int irq)
87 {
88         if( irq < 8) {
89                 m_irq_mask &= ~(1 << irq);
90                 outb(m_irq_mask,I8259_M_MR);
91         } else {
92                 s_irq_mask &= ~(1 << (irq - 8));
93                 outb(s_irq_mask,I8259_S_MR);
94         }
95 }
96
97 static inline int mpc1211_irq_real(unsigned int irq)
98 {
99         int value;
100         int irqmask;
101
102         if ( irq < 8) {
103                 irqmask = 1<<irq;
104                 outb(0x0b,I8259_M_CR);          /* ISR register */
105                 value = inb(I8259_M_CR) & irqmask;
106                 outb(0x0a,I8259_M_CR);          /* back ro the IPR reg */
107                 return value;
108         }
109         irqmask = 1<<(irq - 8);
110         outb(0x0b,I8259_S_CR);          /* ISR register */
111         value = inb(I8259_S_CR) & irqmask;
112         outb(0x0a,I8259_S_CR);          /* back ro the IPR reg */
113         return value;
114 }
115
116 static void mask_and_ack_mpc1211(unsigned int irq)
117 {
118         if(irq < 8) {
119                 if(m_irq_mask & (1<<irq)){
120                   if(!mpc1211_irq_real(irq)){
121                     atomic_inc(&irq_err_count)
122                     printk("spurious 8259A interrupt: IRQ %x\n",irq);
123                    }
124                 } else {
125                         m_irq_mask |= (1<<irq);
126                 }
127                 inb(I8259_M_MR);                /* DUMMY */
128                 outb(m_irq_mask,I8259_M_MR);    /* disable */
129                 outb(0x60+irq,I8259_M_CR);      /* EOI */
130                 
131         } else {
132                 if(s_irq_mask & (1<<(irq - 8))){
133                   if(!mpc1211_irq_real(irq)){
134                     atomic_inc(&irq_err_count);
135                     printk("spurious 8259A interrupt: IRQ %x\n",irq);
136                   }
137                 } else {
138                         s_irq_mask |= (1<<(irq - 8));
139                 }
140                 inb(I8259_S_MR);                /* DUMMY */
141                 outb(s_irq_mask,I8259_S_MR);    /* disable */
142                 outb(0x60+(irq-8),I8259_S_CR);  /* EOI */
143                 outb(0x60+2,I8259_M_CR);
144         }
145 }
146
147 static void end_mpc1211_irq(unsigned int irq)
148 {
149         enable_mpc1211_irq(irq);
150 }
151
152 static unsigned int startup_mpc1211_irq(unsigned int irq)
153 {
154         enable_mpc1211_irq(irq);
155         return 0;
156 }
157
158 static void shutdown_mpc1211_irq(unsigned int irq)
159 {
160         disable_mpc1211_irq(irq);
161 }
162
163 static struct hw_interrupt_type mpc1211_irq_type = {
164         .typename       = "MPC1211-IRQ",
165         .startup        = startup_mpc1211_irq,
166         .shutdown       = shutdown_mpc1211_irq,
167         .enable         = enable_mpc1211_irq,
168         .disable        = disable_mpc1211_irq,
169         .ack            = mask_and_ack_mpc1211,
170         .end            = end_mpc1211_irq
171 };
172
173 static void make_mpc1211_irq(unsigned int irq)
174 {
175         irq_desc[irq].chip = &mpc1211_irq_type;
176         irq_desc[irq].status  = IRQ_DISABLED;
177         irq_desc[irq].action  = 0;
178         irq_desc[irq].depth   = 1;
179         disable_mpc1211_irq(irq);
180 }
181
182 int mpc1211_irq_demux(int irq)
183 {
184         unsigned int poll;
185
186         if( irq == 2 ) {
187                 outb(0x0c,I8259_M_CR);
188                 poll = inb(I8259_M_CR);
189                 if(poll & 0x80) {
190                         irq = (poll & 0x07);
191                 }
192                 if( irq == 2) {
193                         outb(0x0c,I8259_S_CR);
194                         poll = inb(I8259_S_CR);
195                         irq = (poll & 0x07) + 8;
196                 }
197         }
198         return irq;
199 }
200
201 static void __init init_mpc1211_IRQ(void)
202 {
203         int i;
204         /*
205          * Super I/O (Just mimic PC):
206          *  1: keyboard
207          *  3: serial 1
208          *  4: serial 0
209          *  5: printer
210          *  6: floppy
211          *  8: rtc
212          * 10: lan
213          * 12: mouse
214          * 14: ide0
215          * 15: ide1
216          */
217
218         pci_write_config(0,0,0,0x54, 0xb0b0002d);
219         outb(0x11, I8259_M_CR);         /* mater icw1 edge trigger  */
220         outb(0x11, I8259_S_CR);         /* slave icw1 edge trigger  */
221         outb(0x20, I8259_M_MR);         /* m icw2 base vec 0x08     */
222         outb(0x28, I8259_S_MR);         /* s icw2 base vec 0x70     */
223         outb(0x04, I8259_M_MR);         /* m icw3 slave irq2        */
224         outb(0x02, I8259_S_MR);         /* s icw3 slave id          */
225         outb(0x01, I8259_M_MR);         /* m icw4 non buf normal eoi*/
226         outb(0x01, I8259_S_MR);         /* s icw4 non buf normal eo1*/
227         outb(0xfb, I8259_M_MR);         /* disable irq0--irq7  */
228         outb(0xff, I8259_S_MR);         /* disable irq8--irq15 */
229
230         for ( i=0; i < 16; i++) {
231                 if(i != 2) {
232                         make_mpc1211_irq(i);
233                 }
234         }
235 }
236
237 static void delay1000(void)
238 {
239         int i;
240
241         for (i=0; i<1000; i++)
242                 ctrl_delay();
243 }
244
245 static int put_smb_blk(unsigned char *p, int address, int command, int no)
246 {
247         int temp;
248         int timeout;
249         int i;
250
251         outb(0xff, SMBHSTSTS);
252         temp = inb(SMBHSTSTS);
253         for (timeout = 0; (timeout < MAX_TIMEOUT) && !(temp & ALI15X3_STS_IDLE); timeout++) {
254                 delay1000();
255                 temp = inb(SMBHSTSTS);
256         }
257         if (timeout >= MAX_TIMEOUT){
258                 return -1;
259         }
260
261         outb(((address & 0x7f) << 1), SMBHSTADD);
262         outb(0xc0, SMBHSTCNT);
263         outb(command & 0xff, SMBHSTCMD);
264         outb(no & 0x1f, SMBHSTDAT0);
265
266         for(i = 1; i <= no; i++) {
267                 outb(*p++, SMBBLKDAT);
268         }
269         outb(0xff, SMBHSTSTART);
270
271         temp = inb(SMBHSTSTS);
272         for (timeout = 0; (timeout < MAX_TIMEOUT) && !(temp & (ALI15X3_STS_ERR | ALI15X3_STS_DONE)); timeout++) {
273                 delay1000();
274                 temp = inb(SMBHSTSTS);
275         }
276         if (timeout >= MAX_TIMEOUT) {
277                 return -2;
278         }
279         if ( temp & ALI15X3_STS_ERR ){
280                 return -3;
281         }
282         return 0;
283 }
284
285 static struct resource heartbeat_resources[] = {
286         [0] = {
287                 .start  = 0xa2000000,
288                 .end    = 0xa2000000 + 8 - 1,
289                 .flags  = IORESOURCE_MEM,
290         },
291 };
292
293 static struct platform_device heartbeat_device = {
294         .name           = "heartbeat",
295         .id             = -1,
296         .num_resources  = ARRAY_SIZE(heartbeat_resources),
297         .resource       = heartbeat_resources,
298 };
299
300 static struct platform_device *mpc1211_devices[] __initdata = {
301         &heartbeat_device,
302 };
303
304 static int __init mpc1211_devices_setup(void)
305 {
306         return platform_add_devices(mpc1211_devices,
307                                     ARRAY_SIZE(mpc1211_devices));
308 }
309 __initcall(mpc1211_devices_setup);
310
311 /* arch/sh/boards/mpc1211/rtc.c */
312 void mpc1211_time_init(void);
313
314 static void __init mpc1211_setup(char **cmdline_p)
315 {
316         unsigned char spd_buf[128];
317
318         __set_io_port_base(PA_PCI_IO);
319
320         pci_write_config(0,0,0,0x54, 0xb0b00000);
321
322         do {
323                 outb(ALI15X3_ABORT, SMBHSTCNT);
324                 spd_buf[0] = 0x0c;
325                 spd_buf[1] = 0x43;
326                 spd_buf[2] = 0x7f;
327                 spd_buf[3] = 0x03;
328                 spd_buf[4] = 0x00;
329                 spd_buf[5] = 0x03;
330                 spd_buf[6] = 0x00;
331         } while (put_smb_blk(spd_buf, 0x69, 0, 7) < 0);
332
333         board_time_init = mpc1211_time_init;
334
335         return 0;
336 }
337
338 /*
339  * The Machine Vector
340  */
341 struct sh_machine_vector mv_mpc1211 __initmv = {
342         .mv_name                = "Interface MPC-1211(CTP/PCI/MPC-SH02)",
343         .mv_setup               = mpc1211_setup,
344         .mv_nr_irqs             = 48,
345         .mv_irq_demux           = mpc1211_irq_demux,
346         .mv_init_irq            = init_mpc1211_IRQ,
347 };
348 ALIAS_MV(mpc1211)