treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / scsi / mvme16x_scsi.c
blob21d638299ab8e56df786dc9b82b960d0a7a8b3b5
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Detection routine for the NCR53c710 based MVME16x SCSI Controllers for Linux.
5 * Based on work by Alan Hourihane
7 * Rewritten to use 53c700.c by Kars de Jong <jongk@linux-m68k.org>
8 */
10 #include <linux/module.h>
11 #include <linux/blkdev.h>
12 #include <linux/device.h>
13 #include <linux/platform_device.h>
14 #include <linux/init.h>
15 #include <linux/interrupt.h>
16 #include <linux/slab.h>
17 #include <asm/mvme16xhw.h>
18 #include <scsi/scsi_host.h>
19 #include <scsi/scsi_device.h>
20 #include <scsi/scsi_transport.h>
21 #include <scsi/scsi_transport_spi.h>
23 #include "53c700.h"
25 MODULE_AUTHOR("Kars de Jong <jongk@linux-m68k.org>");
26 MODULE_DESCRIPTION("MVME16x NCR53C710 driver");
27 MODULE_LICENSE("GPL");
29 static struct scsi_host_template mvme16x_scsi_driver_template = {
30 .name = "MVME16x NCR53c710 SCSI",
31 .proc_name = "MVME16x",
32 .this_id = 7,
33 .module = THIS_MODULE,
36 static struct platform_device *mvme16x_scsi_device;
38 static int mvme16x_probe(struct platform_device *dev)
40 struct Scsi_Host * host = NULL;
41 struct NCR_700_Host_Parameters *hostdata;
43 if (!MACH_IS_MVME16x)
44 goto out;
46 if (mvme16x_config & MVME16x_CONFIG_NO_SCSICHIP) {
47 printk(KERN_INFO "mvme16x-scsi: detection disabled, "
48 "SCSI chip not present\n");
49 goto out;
52 hostdata = kzalloc(sizeof(struct NCR_700_Host_Parameters), GFP_KERNEL);
53 if (hostdata == NULL) {
54 printk(KERN_ERR "mvme16x-scsi: "
55 "Failed to allocate host data\n");
56 goto out;
59 /* Fill in the required pieces of hostdata */
60 hostdata->base = (void __iomem *)0xfff47000UL;
61 hostdata->clock = 50; /* XXX - depends on the CPU clock! */
62 hostdata->chip710 = 1;
63 hostdata->dmode_extra = DMODE_FC2;
64 hostdata->dcntl_extra = EA_710;
65 hostdata->ctest7_extra = CTEST7_TT1;
67 /* and register the chip */
68 host = NCR_700_detect(&mvme16x_scsi_driver_template, hostdata,
69 &dev->dev);
70 if (!host) {
71 printk(KERN_ERR "mvme16x-scsi: No host detected; "
72 "board configuration problem?\n");
73 goto out_free;
75 host->this_id = 7;
76 host->base = 0xfff47000UL;
77 host->irq = MVME16x_IRQ_SCSI;
78 if (request_irq(host->irq, NCR_700_intr, 0, "mvme16x-scsi", host)) {
79 printk(KERN_ERR "mvme16x-scsi: request_irq failed\n");
80 goto out_put_host;
83 /* Enable scsi chip ints */
85 volatile unsigned long v;
87 /* Enable scsi interrupts at level 4 in PCCchip2 */
88 v = in_be32(0xfff4202c);
89 v = (v & ~0xff) | 0x10 | 4;
90 out_be32(0xfff4202c, v);
93 platform_set_drvdata(dev, host);
94 scsi_scan_host(host);
96 return 0;
98 out_put_host:
99 scsi_host_put(host);
100 out_free:
101 kfree(hostdata);
102 out:
103 return -ENODEV;
106 static int mvme16x_device_remove(struct platform_device *dev)
108 struct Scsi_Host *host = platform_get_drvdata(dev);
109 struct NCR_700_Host_Parameters *hostdata = shost_priv(host);
111 /* Disable scsi chip ints */
113 volatile unsigned long v;
115 v = in_be32(0xfff4202c);
116 v &= ~0x10;
117 out_be32(0xfff4202c, v);
119 scsi_remove_host(host);
120 NCR_700_release(host);
121 kfree(hostdata);
122 free_irq(host->irq, host);
124 return 0;
127 static struct platform_driver mvme16x_scsi_driver = {
128 .driver = {
129 .name = "mvme16x-scsi",
131 .probe = mvme16x_probe,
132 .remove = mvme16x_device_remove,
135 static int __init mvme16x_scsi_init(void)
137 int err;
139 err = platform_driver_register(&mvme16x_scsi_driver);
140 if (err)
141 return err;
143 mvme16x_scsi_device = platform_device_register_simple("mvme16x-scsi",
144 -1, NULL, 0);
145 if (IS_ERR(mvme16x_scsi_device)) {
146 platform_driver_unregister(&mvme16x_scsi_driver);
147 return PTR_ERR(mvme16x_scsi_device);
150 return 0;
153 static void __exit mvme16x_scsi_exit(void)
155 platform_device_unregister(mvme16x_scsi_device);
156 platform_driver_unregister(&mvme16x_scsi_driver);
159 module_init(mvme16x_scsi_init);
160 module_exit(mvme16x_scsi_exit);