xref: /OK3568_Linux_fs/kernel/drivers/scsi/gvp11.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun #include <linux/types.h>
3*4882a593Smuzhiyun #include <linux/init.h>
4*4882a593Smuzhiyun #include <linux/interrupt.h>
5*4882a593Smuzhiyun #include <linux/mm.h>
6*4882a593Smuzhiyun #include <linux/slab.h>
7*4882a593Smuzhiyun #include <linux/spinlock.h>
8*4882a593Smuzhiyun #include <linux/zorro.h>
9*4882a593Smuzhiyun #include <linux/module.h>
10*4882a593Smuzhiyun 
11*4882a593Smuzhiyun #include <asm/page.h>
12*4882a593Smuzhiyun #include <asm/amigaints.h>
13*4882a593Smuzhiyun #include <asm/amigahw.h>
14*4882a593Smuzhiyun 
15*4882a593Smuzhiyun #include "scsi.h"
16*4882a593Smuzhiyun #include "wd33c93.h"
17*4882a593Smuzhiyun #include "gvp11.h"
18*4882a593Smuzhiyun 
19*4882a593Smuzhiyun 
20*4882a593Smuzhiyun #define CHECK_WD33C93
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun struct gvp11_hostdata {
23*4882a593Smuzhiyun 	struct WD33C93_hostdata wh;
24*4882a593Smuzhiyun 	struct gvp11_scsiregs *regs;
25*4882a593Smuzhiyun };
26*4882a593Smuzhiyun 
gvp11_intr(int irq,void * data)27*4882a593Smuzhiyun static irqreturn_t gvp11_intr(int irq, void *data)
28*4882a593Smuzhiyun {
29*4882a593Smuzhiyun 	struct Scsi_Host *instance = data;
30*4882a593Smuzhiyun 	struct gvp11_hostdata *hdata = shost_priv(instance);
31*4882a593Smuzhiyun 	unsigned int status = hdata->regs->CNTR;
32*4882a593Smuzhiyun 	unsigned long flags;
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun 	if (!(status & GVP11_DMAC_INT_PENDING))
35*4882a593Smuzhiyun 		return IRQ_NONE;
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun 	spin_lock_irqsave(instance->host_lock, flags);
38*4882a593Smuzhiyun 	wd33c93_intr(instance);
39*4882a593Smuzhiyun 	spin_unlock_irqrestore(instance->host_lock, flags);
40*4882a593Smuzhiyun 	return IRQ_HANDLED;
41*4882a593Smuzhiyun }
42*4882a593Smuzhiyun 
43*4882a593Smuzhiyun static int gvp11_xfer_mask = 0;
44*4882a593Smuzhiyun 
gvp11_setup(char * str,int * ints)45*4882a593Smuzhiyun void gvp11_setup(char *str, int *ints)
46*4882a593Smuzhiyun {
47*4882a593Smuzhiyun 	gvp11_xfer_mask = ints[1];
48*4882a593Smuzhiyun }
49*4882a593Smuzhiyun 
dma_setup(struct scsi_cmnd * cmd,int dir_in)50*4882a593Smuzhiyun static int dma_setup(struct scsi_cmnd *cmd, int dir_in)
51*4882a593Smuzhiyun {
52*4882a593Smuzhiyun 	struct Scsi_Host *instance = cmd->device->host;
53*4882a593Smuzhiyun 	struct gvp11_hostdata *hdata = shost_priv(instance);
54*4882a593Smuzhiyun 	struct WD33C93_hostdata *wh = &hdata->wh;
55*4882a593Smuzhiyun 	struct gvp11_scsiregs *regs = hdata->regs;
56*4882a593Smuzhiyun 	unsigned short cntr = GVP11_DMAC_INT_ENABLE;
57*4882a593Smuzhiyun 	unsigned long addr = virt_to_bus(cmd->SCp.ptr);
58*4882a593Smuzhiyun 	int bank_mask;
59*4882a593Smuzhiyun 	static int scsi_alloc_out_of_range = 0;
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun 	/* use bounce buffer if the physical address is bad */
62*4882a593Smuzhiyun 	if (addr & wh->dma_xfer_mask) {
63*4882a593Smuzhiyun 		wh->dma_bounce_len = (cmd->SCp.this_residual + 511) & ~0x1ff;
64*4882a593Smuzhiyun 
65*4882a593Smuzhiyun 		if (!scsi_alloc_out_of_range) {
66*4882a593Smuzhiyun 			wh->dma_bounce_buffer =
67*4882a593Smuzhiyun 				kmalloc(wh->dma_bounce_len, GFP_KERNEL);
68*4882a593Smuzhiyun 			wh->dma_buffer_pool = BUF_SCSI_ALLOCED;
69*4882a593Smuzhiyun 		}
70*4882a593Smuzhiyun 
71*4882a593Smuzhiyun 		if (scsi_alloc_out_of_range ||
72*4882a593Smuzhiyun 		    !wh->dma_bounce_buffer) {
73*4882a593Smuzhiyun 			wh->dma_bounce_buffer =
74*4882a593Smuzhiyun 				amiga_chip_alloc(wh->dma_bounce_len,
75*4882a593Smuzhiyun 						 "GVP II SCSI Bounce Buffer");
76*4882a593Smuzhiyun 
77*4882a593Smuzhiyun 			if (!wh->dma_bounce_buffer) {
78*4882a593Smuzhiyun 				wh->dma_bounce_len = 0;
79*4882a593Smuzhiyun 				return 1;
80*4882a593Smuzhiyun 			}
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun 			wh->dma_buffer_pool = BUF_CHIP_ALLOCED;
83*4882a593Smuzhiyun 		}
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun 		/* check if the address of the bounce buffer is OK */
86*4882a593Smuzhiyun 		addr = virt_to_bus(wh->dma_bounce_buffer);
87*4882a593Smuzhiyun 
88*4882a593Smuzhiyun 		if (addr & wh->dma_xfer_mask) {
89*4882a593Smuzhiyun 			/* fall back to Chip RAM if address out of range */
90*4882a593Smuzhiyun 			if (wh->dma_buffer_pool == BUF_SCSI_ALLOCED) {
91*4882a593Smuzhiyun 				kfree(wh->dma_bounce_buffer);
92*4882a593Smuzhiyun 				scsi_alloc_out_of_range = 1;
93*4882a593Smuzhiyun 			} else {
94*4882a593Smuzhiyun 				amiga_chip_free(wh->dma_bounce_buffer);
95*4882a593Smuzhiyun 			}
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun 			wh->dma_bounce_buffer =
98*4882a593Smuzhiyun 				amiga_chip_alloc(wh->dma_bounce_len,
99*4882a593Smuzhiyun 						 "GVP II SCSI Bounce Buffer");
100*4882a593Smuzhiyun 
101*4882a593Smuzhiyun 			if (!wh->dma_bounce_buffer) {
102*4882a593Smuzhiyun 				wh->dma_bounce_len = 0;
103*4882a593Smuzhiyun 				return 1;
104*4882a593Smuzhiyun 			}
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun 			addr = virt_to_bus(wh->dma_bounce_buffer);
107*4882a593Smuzhiyun 			wh->dma_buffer_pool = BUF_CHIP_ALLOCED;
108*4882a593Smuzhiyun 		}
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun 		if (!dir_in) {
111*4882a593Smuzhiyun 			/* copy to bounce buffer for a write */
112*4882a593Smuzhiyun 			memcpy(wh->dma_bounce_buffer, cmd->SCp.ptr,
113*4882a593Smuzhiyun 			       cmd->SCp.this_residual);
114*4882a593Smuzhiyun 		}
115*4882a593Smuzhiyun 	}
116*4882a593Smuzhiyun 
117*4882a593Smuzhiyun 	/* setup dma direction */
118*4882a593Smuzhiyun 	if (!dir_in)
119*4882a593Smuzhiyun 		cntr |= GVP11_DMAC_DIR_WRITE;
120*4882a593Smuzhiyun 
121*4882a593Smuzhiyun 	wh->dma_dir = dir_in;
122*4882a593Smuzhiyun 	regs->CNTR = cntr;
123*4882a593Smuzhiyun 
124*4882a593Smuzhiyun 	/* setup DMA *physical* address */
125*4882a593Smuzhiyun 	regs->ACR = addr;
126*4882a593Smuzhiyun 
127*4882a593Smuzhiyun 	if (dir_in) {
128*4882a593Smuzhiyun 		/* invalidate any cache */
129*4882a593Smuzhiyun 		cache_clear(addr, cmd->SCp.this_residual);
130*4882a593Smuzhiyun 	} else {
131*4882a593Smuzhiyun 		/* push any dirty cache */
132*4882a593Smuzhiyun 		cache_push(addr, cmd->SCp.this_residual);
133*4882a593Smuzhiyun 	}
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun 	bank_mask = (~wh->dma_xfer_mask >> 18) & 0x01c0;
136*4882a593Smuzhiyun 	if (bank_mask)
137*4882a593Smuzhiyun 		regs->BANK = bank_mask & (addr >> 18);
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun 	/* start DMA */
140*4882a593Smuzhiyun 	regs->ST_DMA = 1;
141*4882a593Smuzhiyun 
142*4882a593Smuzhiyun 	/* return success */
143*4882a593Smuzhiyun 	return 0;
144*4882a593Smuzhiyun }
145*4882a593Smuzhiyun 
dma_stop(struct Scsi_Host * instance,struct scsi_cmnd * SCpnt,int status)146*4882a593Smuzhiyun static void dma_stop(struct Scsi_Host *instance, struct scsi_cmnd *SCpnt,
147*4882a593Smuzhiyun 		     int status)
148*4882a593Smuzhiyun {
149*4882a593Smuzhiyun 	struct gvp11_hostdata *hdata = shost_priv(instance);
150*4882a593Smuzhiyun 	struct WD33C93_hostdata *wh = &hdata->wh;
151*4882a593Smuzhiyun 	struct gvp11_scsiregs *regs = hdata->regs;
152*4882a593Smuzhiyun 
153*4882a593Smuzhiyun 	/* stop DMA */
154*4882a593Smuzhiyun 	regs->SP_DMA = 1;
155*4882a593Smuzhiyun 	/* remove write bit from CONTROL bits */
156*4882a593Smuzhiyun 	regs->CNTR = GVP11_DMAC_INT_ENABLE;
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun 	/* copy from a bounce buffer, if necessary */
159*4882a593Smuzhiyun 	if (status && wh->dma_bounce_buffer) {
160*4882a593Smuzhiyun 		if (wh->dma_dir && SCpnt)
161*4882a593Smuzhiyun 			memcpy(SCpnt->SCp.ptr, wh->dma_bounce_buffer,
162*4882a593Smuzhiyun 			       SCpnt->SCp.this_residual);
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun 		if (wh->dma_buffer_pool == BUF_SCSI_ALLOCED)
165*4882a593Smuzhiyun 			kfree(wh->dma_bounce_buffer);
166*4882a593Smuzhiyun 		else
167*4882a593Smuzhiyun 			amiga_chip_free(wh->dma_bounce_buffer);
168*4882a593Smuzhiyun 
169*4882a593Smuzhiyun 		wh->dma_bounce_buffer = NULL;
170*4882a593Smuzhiyun 		wh->dma_bounce_len = 0;
171*4882a593Smuzhiyun 	}
172*4882a593Smuzhiyun }
173*4882a593Smuzhiyun 
174*4882a593Smuzhiyun static struct scsi_host_template gvp11_scsi_template = {
175*4882a593Smuzhiyun 	.module			= THIS_MODULE,
176*4882a593Smuzhiyun 	.name			= "GVP Series II SCSI",
177*4882a593Smuzhiyun 	.show_info		= wd33c93_show_info,
178*4882a593Smuzhiyun 	.write_info		= wd33c93_write_info,
179*4882a593Smuzhiyun 	.proc_name		= "GVP11",
180*4882a593Smuzhiyun 	.queuecommand		= wd33c93_queuecommand,
181*4882a593Smuzhiyun 	.eh_abort_handler	= wd33c93_abort,
182*4882a593Smuzhiyun 	.eh_host_reset_handler	= wd33c93_host_reset,
183*4882a593Smuzhiyun 	.can_queue		= CAN_QUEUE,
184*4882a593Smuzhiyun 	.this_id		= 7,
185*4882a593Smuzhiyun 	.sg_tablesize		= SG_ALL,
186*4882a593Smuzhiyun 	.cmd_per_lun		= CMD_PER_LUN,
187*4882a593Smuzhiyun 	.dma_boundary		= PAGE_SIZE - 1,
188*4882a593Smuzhiyun };
189*4882a593Smuzhiyun 
check_wd33c93(struct gvp11_scsiregs * regs)190*4882a593Smuzhiyun static int check_wd33c93(struct gvp11_scsiregs *regs)
191*4882a593Smuzhiyun {
192*4882a593Smuzhiyun #ifdef CHECK_WD33C93
193*4882a593Smuzhiyun 	volatile unsigned char *sasr_3393, *scmd_3393;
194*4882a593Smuzhiyun 	unsigned char save_sasr;
195*4882a593Smuzhiyun 	unsigned char q, qq;
196*4882a593Smuzhiyun 
197*4882a593Smuzhiyun 	/*
198*4882a593Smuzhiyun 	 * These darn GVP boards are a problem - it can be tough to tell
199*4882a593Smuzhiyun 	 * whether or not they include a SCSI controller. This is the
200*4882a593Smuzhiyun 	 * ultimate Yet-Another-GVP-Detection-Hack in that it actually
201*4882a593Smuzhiyun 	 * probes for a WD33c93 chip: If we find one, it's extremely
202*4882a593Smuzhiyun 	 * likely that this card supports SCSI, regardless of Product_
203*4882a593Smuzhiyun 	 * Code, Board_Size, etc.
204*4882a593Smuzhiyun 	 */
205*4882a593Smuzhiyun 
206*4882a593Smuzhiyun 	/* Get pointers to the presumed register locations and save contents */
207*4882a593Smuzhiyun 
208*4882a593Smuzhiyun 	sasr_3393 = &regs->SASR;
209*4882a593Smuzhiyun 	scmd_3393 = &regs->SCMD;
210*4882a593Smuzhiyun 	save_sasr = *sasr_3393;
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun 	/* First test the AuxStatus Reg */
213*4882a593Smuzhiyun 
214*4882a593Smuzhiyun 	q = *sasr_3393;	/* read it */
215*4882a593Smuzhiyun 	if (q & 0x08)	/* bit 3 should always be clear */
216*4882a593Smuzhiyun 		return -ENODEV;
217*4882a593Smuzhiyun 	*sasr_3393 = WD_AUXILIARY_STATUS;	/* setup indirect address */
218*4882a593Smuzhiyun 	if (*sasr_3393 == WD_AUXILIARY_STATUS) {	/* shouldn't retain the write */
219*4882a593Smuzhiyun 		*sasr_3393 = save_sasr;	/* Oops - restore this byte */
220*4882a593Smuzhiyun 		return -ENODEV;
221*4882a593Smuzhiyun 	}
222*4882a593Smuzhiyun 	if (*sasr_3393 != q) {	/* should still read the same */
223*4882a593Smuzhiyun 		*sasr_3393 = save_sasr;	/* Oops - restore this byte */
224*4882a593Smuzhiyun 		return -ENODEV;
225*4882a593Smuzhiyun 	}
226*4882a593Smuzhiyun 	if (*scmd_3393 != q)	/* and so should the image at 0x1f */
227*4882a593Smuzhiyun 		return -ENODEV;
228*4882a593Smuzhiyun 
229*4882a593Smuzhiyun 	/*
230*4882a593Smuzhiyun 	 * Ok, we probably have a wd33c93, but let's check a few other places
231*4882a593Smuzhiyun 	 * for good measure. Make sure that this works for both 'A and 'B
232*4882a593Smuzhiyun 	 * chip versions.
233*4882a593Smuzhiyun 	 */
234*4882a593Smuzhiyun 
235*4882a593Smuzhiyun 	*sasr_3393 = WD_SCSI_STATUS;
236*4882a593Smuzhiyun 	q = *scmd_3393;
237*4882a593Smuzhiyun 	*sasr_3393 = WD_SCSI_STATUS;
238*4882a593Smuzhiyun 	*scmd_3393 = ~q;
239*4882a593Smuzhiyun 	*sasr_3393 = WD_SCSI_STATUS;
240*4882a593Smuzhiyun 	qq = *scmd_3393;
241*4882a593Smuzhiyun 	*sasr_3393 = WD_SCSI_STATUS;
242*4882a593Smuzhiyun 	*scmd_3393 = q;
243*4882a593Smuzhiyun 	if (qq != q)	/* should be read only */
244*4882a593Smuzhiyun 		return -ENODEV;
245*4882a593Smuzhiyun 	*sasr_3393 = 0x1e;	/* this register is unimplemented */
246*4882a593Smuzhiyun 	q = *scmd_3393;
247*4882a593Smuzhiyun 	*sasr_3393 = 0x1e;
248*4882a593Smuzhiyun 	*scmd_3393 = ~q;
249*4882a593Smuzhiyun 	*sasr_3393 = 0x1e;
250*4882a593Smuzhiyun 	qq = *scmd_3393;
251*4882a593Smuzhiyun 	*sasr_3393 = 0x1e;
252*4882a593Smuzhiyun 	*scmd_3393 = q;
253*4882a593Smuzhiyun 	if (qq != q || qq != 0xff)	/* should be read only, all 1's */
254*4882a593Smuzhiyun 		return -ENODEV;
255*4882a593Smuzhiyun 	*sasr_3393 = WD_TIMEOUT_PERIOD;
256*4882a593Smuzhiyun 	q = *scmd_3393;
257*4882a593Smuzhiyun 	*sasr_3393 = WD_TIMEOUT_PERIOD;
258*4882a593Smuzhiyun 	*scmd_3393 = ~q;
259*4882a593Smuzhiyun 	*sasr_3393 = WD_TIMEOUT_PERIOD;
260*4882a593Smuzhiyun 	qq = *scmd_3393;
261*4882a593Smuzhiyun 	*sasr_3393 = WD_TIMEOUT_PERIOD;
262*4882a593Smuzhiyun 	*scmd_3393 = q;
263*4882a593Smuzhiyun 	if (qq != (~q & 0xff))	/* should be read/write */
264*4882a593Smuzhiyun 		return -ENODEV;
265*4882a593Smuzhiyun #endif /* CHECK_WD33C93 */
266*4882a593Smuzhiyun 
267*4882a593Smuzhiyun 	return 0;
268*4882a593Smuzhiyun }
269*4882a593Smuzhiyun 
gvp11_probe(struct zorro_dev * z,const struct zorro_device_id * ent)270*4882a593Smuzhiyun static int gvp11_probe(struct zorro_dev *z, const struct zorro_device_id *ent)
271*4882a593Smuzhiyun {
272*4882a593Smuzhiyun 	struct Scsi_Host *instance;
273*4882a593Smuzhiyun 	unsigned long address;
274*4882a593Smuzhiyun 	int error;
275*4882a593Smuzhiyun 	unsigned int epc;
276*4882a593Smuzhiyun 	unsigned int default_dma_xfer_mask;
277*4882a593Smuzhiyun 	struct gvp11_hostdata *hdata;
278*4882a593Smuzhiyun 	struct gvp11_scsiregs *regs;
279*4882a593Smuzhiyun 	wd33c93_regs wdregs;
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun 	default_dma_xfer_mask = ent->driver_data;
282*4882a593Smuzhiyun 
283*4882a593Smuzhiyun 	/*
284*4882a593Smuzhiyun 	 * Rumors state that some GVP ram boards use the same product
285*4882a593Smuzhiyun 	 * code as the SCSI controllers. Therefore if the board-size
286*4882a593Smuzhiyun 	 * is not 64KB we assume it is a ram board and bail out.
287*4882a593Smuzhiyun 	 */
288*4882a593Smuzhiyun 	if (zorro_resource_len(z) != 0x10000)
289*4882a593Smuzhiyun 		return -ENODEV;
290*4882a593Smuzhiyun 
291*4882a593Smuzhiyun 	address = z->resource.start;
292*4882a593Smuzhiyun 	if (!request_mem_region(address, 256, "wd33c93"))
293*4882a593Smuzhiyun 		return -EBUSY;
294*4882a593Smuzhiyun 
295*4882a593Smuzhiyun 	regs = ZTWO_VADDR(address);
296*4882a593Smuzhiyun 
297*4882a593Smuzhiyun 	error = check_wd33c93(regs);
298*4882a593Smuzhiyun 	if (error)
299*4882a593Smuzhiyun 		goto fail_check_or_alloc;
300*4882a593Smuzhiyun 
301*4882a593Smuzhiyun 	instance = scsi_host_alloc(&gvp11_scsi_template,
302*4882a593Smuzhiyun 				   sizeof(struct gvp11_hostdata));
303*4882a593Smuzhiyun 	if (!instance) {
304*4882a593Smuzhiyun 		error = -ENOMEM;
305*4882a593Smuzhiyun 		goto fail_check_or_alloc;
306*4882a593Smuzhiyun 	}
307*4882a593Smuzhiyun 
308*4882a593Smuzhiyun 	instance->irq = IRQ_AMIGA_PORTS;
309*4882a593Smuzhiyun 	instance->unique_id = z->slotaddr;
310*4882a593Smuzhiyun 
311*4882a593Smuzhiyun 	regs->secret2 = 1;
312*4882a593Smuzhiyun 	regs->secret1 = 0;
313*4882a593Smuzhiyun 	regs->secret3 = 15;
314*4882a593Smuzhiyun 	while (regs->CNTR & GVP11_DMAC_BUSY)
315*4882a593Smuzhiyun 		;
316*4882a593Smuzhiyun 	regs->CNTR = 0;
317*4882a593Smuzhiyun 	regs->BANK = 0;
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun 	wdregs.SASR = &regs->SASR;
320*4882a593Smuzhiyun 	wdregs.SCMD = &regs->SCMD;
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	hdata = shost_priv(instance);
323*4882a593Smuzhiyun 	if (gvp11_xfer_mask)
324*4882a593Smuzhiyun 		hdata->wh.dma_xfer_mask = gvp11_xfer_mask;
325*4882a593Smuzhiyun 	else
326*4882a593Smuzhiyun 		hdata->wh.dma_xfer_mask = default_dma_xfer_mask;
327*4882a593Smuzhiyun 
328*4882a593Smuzhiyun 	hdata->wh.no_sync = 0xff;
329*4882a593Smuzhiyun 	hdata->wh.fast = 0;
330*4882a593Smuzhiyun 	hdata->wh.dma_mode = CTRL_DMA;
331*4882a593Smuzhiyun 	hdata->regs = regs;
332*4882a593Smuzhiyun 
333*4882a593Smuzhiyun 	/*
334*4882a593Smuzhiyun 	 * Check for 14MHz SCSI clock
335*4882a593Smuzhiyun 	 */
336*4882a593Smuzhiyun 	epc = *(unsigned short *)(ZTWO_VADDR(address) + 0x8000);
337*4882a593Smuzhiyun 	wd33c93_init(instance, wdregs, dma_setup, dma_stop,
338*4882a593Smuzhiyun 		     (epc & GVP_SCSICLKMASK) ? WD33C93_FS_8_10
339*4882a593Smuzhiyun 					     : WD33C93_FS_12_15);
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun 	error = request_irq(IRQ_AMIGA_PORTS, gvp11_intr, IRQF_SHARED,
342*4882a593Smuzhiyun 			    "GVP11 SCSI", instance);
343*4882a593Smuzhiyun 	if (error)
344*4882a593Smuzhiyun 		goto fail_irq;
345*4882a593Smuzhiyun 
346*4882a593Smuzhiyun 	regs->CNTR = GVP11_DMAC_INT_ENABLE;
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun 	error = scsi_add_host(instance, NULL);
349*4882a593Smuzhiyun 	if (error)
350*4882a593Smuzhiyun 		goto fail_host;
351*4882a593Smuzhiyun 
352*4882a593Smuzhiyun 	zorro_set_drvdata(z, instance);
353*4882a593Smuzhiyun 	scsi_scan_host(instance);
354*4882a593Smuzhiyun 	return 0;
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun fail_host:
357*4882a593Smuzhiyun 	free_irq(IRQ_AMIGA_PORTS, instance);
358*4882a593Smuzhiyun fail_irq:
359*4882a593Smuzhiyun 	scsi_host_put(instance);
360*4882a593Smuzhiyun fail_check_or_alloc:
361*4882a593Smuzhiyun 	release_mem_region(address, 256);
362*4882a593Smuzhiyun 	return error;
363*4882a593Smuzhiyun }
364*4882a593Smuzhiyun 
gvp11_remove(struct zorro_dev * z)365*4882a593Smuzhiyun static void gvp11_remove(struct zorro_dev *z)
366*4882a593Smuzhiyun {
367*4882a593Smuzhiyun 	struct Scsi_Host *instance = zorro_get_drvdata(z);
368*4882a593Smuzhiyun 	struct gvp11_hostdata *hdata = shost_priv(instance);
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun 	hdata->regs->CNTR = 0;
371*4882a593Smuzhiyun 	scsi_remove_host(instance);
372*4882a593Smuzhiyun 	free_irq(IRQ_AMIGA_PORTS, instance);
373*4882a593Smuzhiyun 	scsi_host_put(instance);
374*4882a593Smuzhiyun 	release_mem_region(z->resource.start, 256);
375*4882a593Smuzhiyun }
376*4882a593Smuzhiyun 
377*4882a593Smuzhiyun 	/*
378*4882a593Smuzhiyun 	 * This should (hopefully) be the correct way to identify
379*4882a593Smuzhiyun 	 * all the different GVP SCSI controllers (except for the
380*4882a593Smuzhiyun 	 * SERIES I though).
381*4882a593Smuzhiyun 	 */
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun static struct zorro_device_id gvp11_zorro_tbl[] = {
384*4882a593Smuzhiyun 	{ ZORRO_PROD_GVP_COMBO_030_R3_SCSI,	~0x00ffffff },
385*4882a593Smuzhiyun 	{ ZORRO_PROD_GVP_SERIES_II,		~0x00ffffff },
386*4882a593Smuzhiyun 	{ ZORRO_PROD_GVP_GFORCE_030_SCSI,	~0x01ffffff },
387*4882a593Smuzhiyun 	{ ZORRO_PROD_GVP_A530_SCSI,		~0x01ffffff },
388*4882a593Smuzhiyun 	{ ZORRO_PROD_GVP_COMBO_030_R4_SCSI,	~0x01ffffff },
389*4882a593Smuzhiyun 	{ ZORRO_PROD_GVP_A1291,			~0x07ffffff },
390*4882a593Smuzhiyun 	{ ZORRO_PROD_GVP_GFORCE_040_SCSI_1,	~0x07ffffff },
391*4882a593Smuzhiyun 	{ 0 }
392*4882a593Smuzhiyun };
393*4882a593Smuzhiyun MODULE_DEVICE_TABLE(zorro, gvp11_zorro_tbl);
394*4882a593Smuzhiyun 
395*4882a593Smuzhiyun static struct zorro_driver gvp11_driver = {
396*4882a593Smuzhiyun 	.name		= "gvp11",
397*4882a593Smuzhiyun 	.id_table	= gvp11_zorro_tbl,
398*4882a593Smuzhiyun 	.probe		= gvp11_probe,
399*4882a593Smuzhiyun 	.remove		= gvp11_remove,
400*4882a593Smuzhiyun };
401*4882a593Smuzhiyun 
gvp11_init(void)402*4882a593Smuzhiyun static int __init gvp11_init(void)
403*4882a593Smuzhiyun {
404*4882a593Smuzhiyun 	return zorro_register_driver(&gvp11_driver);
405*4882a593Smuzhiyun }
406*4882a593Smuzhiyun module_init(gvp11_init);
407*4882a593Smuzhiyun 
gvp11_exit(void)408*4882a593Smuzhiyun static void __exit gvp11_exit(void)
409*4882a593Smuzhiyun {
410*4882a593Smuzhiyun 	zorro_unregister_driver(&gvp11_driver);
411*4882a593Smuzhiyun }
412*4882a593Smuzhiyun module_exit(gvp11_exit);
413*4882a593Smuzhiyun 
414*4882a593Smuzhiyun MODULE_DESCRIPTION("GVP Series II SCSI");
415*4882a593Smuzhiyun MODULE_LICENSE("GPL");
416