kbuild: Fix instrumentation removal breakage on avr32
[wrt350n-kernel.git] / drivers / scsi / NCR_Q720.c
bloba8bbdc2273b84d8d110cf93e4b6462b1da2f97c8
1 /* -*- mode: c; c-basic-offset: 8 -*- */
3 /* NCR Quad 720 MCA SCSI Driver
5 * Copyright (C) 2003 by James.Bottomley@HansenPartnership.com
6 */
8 #include <linux/blkdev.h>
9 #include <linux/interrupt.h>
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/mca.h>
13 #include <linux/types.h>
14 #include <linux/init.h>
15 #include <linux/delay.h>
16 #include <asm/io.h>
18 #include "scsi.h"
19 #include <scsi/scsi_host.h>
21 #include "ncr53c8xx.h"
23 #include "NCR_Q720.h"
25 static struct ncr_chip q720_chip __initdata = {
26 .revision_id = 0x0f,
27 .burst_max = 3,
28 .offset_max = 8,
29 .nr_divisor = 4,
30 .features = FE_WIDE | FE_DIFF | FE_VARCLK,
33 MODULE_AUTHOR("James Bottomley");
34 MODULE_DESCRIPTION("NCR Quad 720 SCSI Driver");
35 MODULE_LICENSE("GPL");
37 #define NCR_Q720_VERSION "0.9"
39 /* We needs this helper because we have up to four hosts per struct device */
40 struct NCR_Q720_private {
41 struct device *dev;
42 void __iomem * mem_base;
43 __u32 phys_mem_base;
44 __u32 mem_size;
45 __u8 irq;
46 __u8 siops;
47 __u8 irq_enable;
48 struct Scsi_Host *hosts[4];
51 static struct scsi_host_template NCR_Q720_tpnt = {
52 .module = THIS_MODULE,
53 .proc_name = "NCR_Q720",
56 static irqreturn_t
57 NCR_Q720_intr(int irq, void *data)
59 struct NCR_Q720_private *p = (struct NCR_Q720_private *)data;
60 __u8 sir = (readb(p->mem_base + 0x0d) & 0xf0) >> 4;
61 __u8 siop;
63 sir |= ~p->irq_enable;
65 if(sir == 0xff)
66 return IRQ_NONE;
69 while((siop = ffz(sir)) < p->siops) {
70 sir |= 1<<siop;
71 ncr53c8xx_intr(irq, p->hosts[siop]);
73 return IRQ_HANDLED;
76 static int __init
77 NCR_Q720_probe_one(struct NCR_Q720_private *p, int siop,
78 int irq, int slot, __u32 paddr, void __iomem *vaddr)
80 struct ncr_device device;
81 __u8 scsi_id;
82 static int unit = 0;
83 __u8 scsr1 = readb(vaddr + NCR_Q720_SCSR_OFFSET + 1);
84 __u8 differential = readb(vaddr + NCR_Q720_SCSR_OFFSET) & 0x20;
85 __u8 version;
86 int error;
88 scsi_id = scsr1 >> 4;
89 /* enable burst length 16 (FIXME: should allow this) */
90 scsr1 |= 0x02;
91 /* force a siop reset */
92 scsr1 |= 0x04;
93 writeb(scsr1, vaddr + NCR_Q720_SCSR_OFFSET + 1);
94 udelay(10);
95 version = readb(vaddr + 0x18) >> 4;
97 memset(&device, 0, sizeof(struct ncr_device));
98 /* Initialise ncr_device structure with items required by ncr_attach. */
99 device.chip = q720_chip;
100 device.chip.revision_id = version;
101 device.host_id = scsi_id;
102 device.dev = p->dev;
103 device.slot.base = paddr;
104 device.slot.base_c = paddr;
105 device.slot.base_v = vaddr;
106 device.slot.irq = irq;
107 device.differential = differential ? 2 : 0;
108 printk("Q720 probe unit %d (siop%d) at 0x%lx, diff = %d, vers = %d\n", unit, siop,
109 (unsigned long)paddr, differential, version);
111 p->hosts[siop] = ncr_attach(&NCR_Q720_tpnt, unit++, &device);
113 if (!p->hosts[siop])
114 goto fail;
116 p->irq_enable |= (1<<siop);
117 scsr1 = readb(vaddr + NCR_Q720_SCSR_OFFSET + 1);
118 /* clear the disable interrupt bit */
119 scsr1 &= ~0x01;
120 writeb(scsr1, vaddr + NCR_Q720_SCSR_OFFSET + 1);
122 error = scsi_add_host(p->hosts[siop], p->dev);
123 if (error)
124 ncr53c8xx_release(p->hosts[siop]);
125 else
126 scsi_scan_host(p->hosts[siop]);
127 return error;
129 fail:
130 return -ENODEV;
133 /* Detect a Q720 card. Note, because of the setup --- the chips are
134 * essentially connectecd to the MCA bus independently, it is easier
135 * to set them up as two separate host adapters, rather than one
136 * adapter with two channels */
137 static int __init
138 NCR_Q720_probe(struct device *dev)
140 struct NCR_Q720_private *p;
141 static int banner = 1;
142 struct mca_device *mca_dev = to_mca_device(dev);
143 int slot = mca_dev->slot;
144 int found = 0;
145 int irq, i, siops;
146 __u8 pos2, pos4, asr2, asr9, asr10;
147 __u16 io_base;
148 __u32 base_addr, mem_size;
149 void __iomem *mem_base;
151 p = kzalloc(sizeof(*p), GFP_KERNEL);
152 if (!p)
153 return -ENOMEM;
155 pos2 = mca_device_read_pos(mca_dev, 2);
156 /* enable device */
157 pos2 |= NCR_Q720_POS2_BOARD_ENABLE | NCR_Q720_POS2_INTERRUPT_ENABLE;
158 mca_device_write_pos(mca_dev, 2, pos2);
160 io_base = (pos2 & NCR_Q720_POS2_IO_MASK) << NCR_Q720_POS2_IO_SHIFT;
163 if(banner) {
164 printk(KERN_NOTICE "NCR Q720: Driver Version " NCR_Q720_VERSION "\n"
165 "NCR Q720: Copyright (c) 2003 by James.Bottomley@HansenPartnership.com\n"
166 "NCR Q720:\n");
167 banner = 0;
169 io_base = mca_device_transform_ioport(mca_dev, io_base);
171 /* OK, this is phase one of the bootstrap, we now know the
172 * I/O space base address. All the configuration registers
173 * are mapped here (including pos) */
175 /* sanity check I/O mapping */
176 i = inb(io_base) | (inb(io_base+1)<<8);
177 if(i != NCR_Q720_MCA_ID) {
178 printk(KERN_ERR "NCR_Q720, adapter failed to I/O map registers correctly at 0x%x(0x%x)\n", io_base, i);
179 kfree(p);
180 return -ENODEV;
183 /* Phase II, find the ram base and memory map the board register */
184 pos4 = inb(io_base + 4);
185 /* enable streaming data */
186 pos4 |= 0x01;
187 outb(pos4, io_base + 4);
188 base_addr = (pos4 & 0x7e) << 20;
189 base_addr += (pos4 & 0x80) << 23;
190 asr10 = inb(io_base + 0x12);
191 base_addr += (asr10 & 0x80) << 24;
192 base_addr += (asr10 & 0x70) << 23;
194 /* OK, got the base addr, now we need to find the ram size,
195 * enable and map it */
196 asr9 = inb(io_base + 0x11);
197 i = (asr9 & 0xc0) >> 6;
198 if(i == 0)
199 mem_size = 1024;
200 else
201 mem_size = 1 << (19 + i);
203 /* enable the sram mapping */
204 asr9 |= 0x20;
206 /* disable the rom mapping */
207 asr9 &= ~0x10;
209 outb(asr9, io_base + 0x11);
211 if(!request_mem_region(base_addr, mem_size, "NCR_Q720")) {
212 printk(KERN_ERR "NCR_Q720: Failed to claim memory region 0x%lx\n-0x%lx",
213 (unsigned long)base_addr,
214 (unsigned long)(base_addr + mem_size));
215 goto out_free;
218 if (dma_declare_coherent_memory(dev, base_addr, base_addr,
219 mem_size, DMA_MEMORY_MAP)
220 != DMA_MEMORY_MAP) {
221 printk(KERN_ERR "NCR_Q720: DMA declare memory failed\n");
222 goto out_release_region;
225 /* The first 1k of the memory buffer is a memory map of the registers
227 mem_base = dma_mark_declared_memory_occupied(dev, base_addr,
228 1024);
229 if (IS_ERR(mem_base)) {
230 printk("NCR_Q720 failed to reserve memory mapped region\n");
231 goto out_release;
234 /* now also enable accesses in asr 2 */
235 asr2 = inb(io_base + 0x0a);
237 asr2 |= 0x01;
239 outb(asr2, io_base + 0x0a);
241 /* get the number of SIOPs (this should be 2 or 4) */
242 siops = ((asr2 & 0xe0) >> 5) + 1;
244 /* sanity check mapping (again) */
245 i = readw(mem_base);
246 if(i != NCR_Q720_MCA_ID) {
247 printk(KERN_ERR "NCR_Q720, adapter failed to memory map registers correctly at 0x%lx(0x%x)\n", (unsigned long)base_addr, i);
248 goto out_release;
251 irq = readb(mem_base + 5) & 0x0f;
254 /* now do the bus related transforms */
255 irq = mca_device_transform_irq(mca_dev, irq);
257 printk(KERN_NOTICE "NCR Q720: found in slot %d irq = %d mem base = 0x%lx siops = %d\n", slot, irq, (unsigned long)base_addr, siops);
258 printk(KERN_NOTICE "NCR Q720: On board ram %dk\n", mem_size/1024);
260 p->dev = dev;
261 p->mem_base = mem_base;
262 p->phys_mem_base = base_addr;
263 p->mem_size = mem_size;
264 p->irq = irq;
265 p->siops = siops;
267 if (request_irq(irq, NCR_Q720_intr, IRQF_SHARED, "NCR_Q720", p)) {
268 printk(KERN_ERR "NCR_Q720: request irq %d failed\n", irq);
269 goto out_release;
271 /* disable all the siop interrupts */
272 for(i = 0; i < siops; i++) {
273 void __iomem *reg_scsr1 = mem_base + NCR_Q720_CHIP_REGISTER_OFFSET
274 + i*NCR_Q720_SIOP_SHIFT + NCR_Q720_SCSR_OFFSET + 1;
275 __u8 scsr1 = readb(reg_scsr1);
276 scsr1 |= 0x01;
277 writeb(scsr1, reg_scsr1);
280 /* plumb in all 720 chips */
281 for (i = 0; i < siops; i++) {
282 void __iomem *siop_v_base = mem_base + NCR_Q720_CHIP_REGISTER_OFFSET
283 + i*NCR_Q720_SIOP_SHIFT;
284 __u32 siop_p_base = base_addr + NCR_Q720_CHIP_REGISTER_OFFSET
285 + i*NCR_Q720_SIOP_SHIFT;
286 __u16 port = io_base + NCR_Q720_CHIP_REGISTER_OFFSET
287 + i*NCR_Q720_SIOP_SHIFT;
288 int err;
290 outb(0xff, port + 0x40);
291 outb(0x07, port + 0x41);
292 if ((err = NCR_Q720_probe_one(p, i, irq, slot,
293 siop_p_base, siop_v_base)) != 0)
294 printk("Q720: SIOP%d: probe failed, error = %d\n",
295 i, err);
296 else
297 found++;
300 if (!found) {
301 kfree(p);
302 return -ENODEV;
305 mca_device_set_claim(mca_dev, 1);
306 mca_device_set_name(mca_dev, "NCR_Q720");
307 dev_set_drvdata(dev, p);
309 return 0;
311 out_release:
312 dma_release_declared_memory(dev);
313 out_release_region:
314 release_mem_region(base_addr, mem_size);
315 out_free:
316 kfree(p);
318 return -ENODEV;
321 static void __exit
322 NCR_Q720_remove_one(struct Scsi_Host *host)
324 scsi_remove_host(host);
325 ncr53c8xx_release(host);
328 static int __exit
329 NCR_Q720_remove(struct device *dev)
331 struct NCR_Q720_private *p = dev_get_drvdata(dev);
332 int i;
334 for (i = 0; i < p->siops; i++)
335 if(p->hosts[i])
336 NCR_Q720_remove_one(p->hosts[i]);
338 dma_release_declared_memory(dev);
339 release_mem_region(p->phys_mem_base, p->mem_size);
340 free_irq(p->irq, p);
341 kfree(p);
342 return 0;
345 static short NCR_Q720_id_table[] = { NCR_Q720_MCA_ID, 0 };
347 static struct mca_driver NCR_Q720_driver = {
348 .id_table = NCR_Q720_id_table,
349 .driver = {
350 .name = "NCR_Q720",
351 .bus = &mca_bus_type,
352 .probe = NCR_Q720_probe,
353 .remove = __devexit_p(NCR_Q720_remove),
357 static int __init
358 NCR_Q720_init(void)
360 int ret = ncr53c8xx_init();
361 if (!ret)
362 ret = mca_register_driver(&NCR_Q720_driver);
363 if (ret)
364 ncr53c8xx_exit();
365 return ret;
368 static void __exit
369 NCR_Q720_exit(void)
371 mca_unregister_driver(&NCR_Q720_driver);
372 ncr53c8xx_exit();
375 module_init(NCR_Q720_init);
376 module_exit(NCR_Q720_exit);