mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-25 21:54:06 +08:00
a1d4f73a00
This patch fixes a NULL pointer dereference spotted by the Coverity checker. Signed-off-by: Adrian Bunk <bunk@stusta.de> Signed-off-by: James Bottomley <James.Bottomley@SteelEye.com>
374 lines
9.7 KiB
C
374 lines
9.7 KiB
C
/*
|
|
* sim710.c - Copyright (C) 1999 Richard Hirst <richard@sleepie.demon.co.uk>
|
|
*
|
|
*----------------------------------------------------------------------------
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*----------------------------------------------------------------------------
|
|
*
|
|
* MCA card detection code by Trent McNair.
|
|
* Fixes to not explicitly nul bss data from Xavier Bestel.
|
|
* Some multiboard fixes from Rolf Eike Beer.
|
|
* Auto probing of EISA config space from Trevor Hemsley.
|
|
*
|
|
* Rewritten to use 53c700.c by James.Bottomley@SteelEye.com
|
|
*
|
|
*/
|
|
|
|
#include <linux/config.h>
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/blkdev.h>
|
|
#include <linux/device.h>
|
|
#include <linux/init.h>
|
|
#include <linux/mca.h>
|
|
#include <linux/eisa.h>
|
|
#include <linux/interrupt.h>
|
|
#include <scsi/scsi_host.h>
|
|
#include <scsi/scsi_device.h>
|
|
#include <scsi/scsi_transport.h>
|
|
#include <scsi/scsi_transport_spi.h>
|
|
|
|
#include "53c700.h"
|
|
|
|
|
|
/* Must be enough for both EISA and MCA */
|
|
#define MAX_SLOTS 8
|
|
static __u8 __initdata id_array[MAX_SLOTS] = { [0 ... MAX_SLOTS-1] = 7 };
|
|
|
|
static char *sim710; /* command line passed by insmod */
|
|
|
|
MODULE_AUTHOR("Richard Hirst");
|
|
MODULE_DESCRIPTION("Simple NCR53C710 driver");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
module_param(sim710, charp, 0);
|
|
|
|
#ifdef MODULE
|
|
#define ARG_SEP ' '
|
|
#else
|
|
#define ARG_SEP ','
|
|
#endif
|
|
|
|
static __init int
|
|
param_setup(char *str)
|
|
{
|
|
char *pos = str, *next;
|
|
int slot = -1;
|
|
|
|
while(pos != NULL && (next = strchr(pos, ':')) != NULL) {
|
|
int val = (int)simple_strtoul(++next, NULL, 0);
|
|
|
|
if(!strncmp(pos, "slot:", 5))
|
|
slot = val;
|
|
else if(!strncmp(pos, "id:", 3)) {
|
|
if(slot == -1) {
|
|
printk(KERN_WARNING "sim710: Must specify slot for id parameter\n");
|
|
} else if(slot > MAX_SLOTS) {
|
|
printk(KERN_WARNING "sim710: Illegal slot %d for id %d\n", slot, val);
|
|
} else {
|
|
id_array[slot] = val;
|
|
}
|
|
}
|
|
if((pos = strchr(pos, ARG_SEP)) != NULL)
|
|
pos++;
|
|
}
|
|
return 1;
|
|
}
|
|
__setup("sim710=", param_setup);
|
|
|
|
static struct scsi_host_template sim710_driver_template = {
|
|
.name = "LSI (Symbios) 710 MCA/EISA",
|
|
.proc_name = "sim710",
|
|
.this_id = 7,
|
|
.module = THIS_MODULE,
|
|
};
|
|
|
|
static __devinit int
|
|
sim710_probe_common(struct device *dev, unsigned long base_addr,
|
|
int irq, int clock, int differential, int scsi_id)
|
|
{
|
|
struct Scsi_Host * host = NULL;
|
|
struct NCR_700_Host_Parameters *hostdata =
|
|
kmalloc(sizeof(struct NCR_700_Host_Parameters), GFP_KERNEL);
|
|
|
|
printk(KERN_NOTICE "sim710: %s\n", dev->bus_id);
|
|
printk(KERN_NOTICE "sim710: irq = %d, clock = %d, base = 0x%lx, scsi_id = %d\n",
|
|
irq, clock, base_addr, scsi_id);
|
|
|
|
if(hostdata == NULL) {
|
|
printk(KERN_ERR "sim710: Failed to allocate host data\n");
|
|
goto out;
|
|
}
|
|
memset(hostdata, 0, sizeof(struct NCR_700_Host_Parameters));
|
|
|
|
if(request_region(base_addr, 64, "sim710") == NULL) {
|
|
printk(KERN_ERR "sim710: Failed to reserve IO region 0x%lx\n",
|
|
base_addr);
|
|
goto out_free;
|
|
}
|
|
|
|
/* Fill in the three required pieces of hostdata */
|
|
hostdata->base = ioport_map(base_addr, 64);
|
|
hostdata->differential = differential;
|
|
hostdata->clock = clock;
|
|
hostdata->chip710 = 1;
|
|
|
|
/* and register the chip */
|
|
if((host = NCR_700_detect(&sim710_driver_template, hostdata, dev))
|
|
== NULL) {
|
|
printk(KERN_ERR "sim710: No host detected; card configuration problem?\n");
|
|
goto out_release;
|
|
}
|
|
host->this_id = scsi_id;
|
|
host->base = base_addr;
|
|
host->irq = irq;
|
|
if (request_irq(irq, NCR_700_intr, SA_SHIRQ, "sim710", host)) {
|
|
printk(KERN_ERR "sim710: request_irq failed\n");
|
|
goto out_put_host;
|
|
}
|
|
|
|
scsi_scan_host(host);
|
|
|
|
return 0;
|
|
|
|
out_put_host:
|
|
scsi_host_put(host);
|
|
out_release:
|
|
release_region(base_addr, 64);
|
|
out_free:
|
|
kfree(hostdata);
|
|
out:
|
|
return -ENODEV;
|
|
}
|
|
|
|
static __devexit int
|
|
sim710_device_remove(struct device *dev)
|
|
{
|
|
struct Scsi_Host *host = dev_to_shost(dev);
|
|
struct NCR_700_Host_Parameters *hostdata =
|
|
(struct NCR_700_Host_Parameters *)host->hostdata[0];
|
|
|
|
scsi_remove_host(host);
|
|
NCR_700_release(host);
|
|
kfree(hostdata);
|
|
free_irq(host->irq, host);
|
|
release_region(host->base, 64);
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_MCA
|
|
|
|
/* CARD ID 01BB and 01BA use the same pos values */
|
|
#define MCA_01BB_IO_PORTS { 0x0000, 0x0000, 0x0800, 0x0C00, 0x1000, 0x1400, \
|
|
0x1800, 0x1C00, 0x2000, 0x2400, 0x2800, \
|
|
0x2C00, 0x3000, 0x3400, 0x3800, 0x3C00, \
|
|
0x4000, 0x4400, 0x4800, 0x4C00, 0x5000 }
|
|
|
|
#define MCA_01BB_IRQS { 3, 5, 11, 14 }
|
|
|
|
/* CARD ID 004f */
|
|
#define MCA_004F_IO_PORTS { 0x0000, 0x0200, 0x0300, 0x0400, 0x0500, 0x0600 }
|
|
#define MCA_004F_IRQS { 5, 9, 14 }
|
|
|
|
static short sim710_mca_id_table[] = { 0x01bb, 0x01ba, 0x004f, 0};
|
|
|
|
static __init int
|
|
sim710_mca_probe(struct device *dev)
|
|
{
|
|
struct mca_device *mca_dev = to_mca_device(dev);
|
|
int slot = mca_dev->slot;
|
|
int pos[3];
|
|
unsigned int base;
|
|
int irq_vector;
|
|
short id = sim710_mca_id_table[mca_dev->index];
|
|
static int io_004f_by_pos[] = MCA_004F_IO_PORTS;
|
|
static int irq_004f_by_pos[] = MCA_004F_IRQS;
|
|
static int io_01bb_by_pos[] = MCA_01BB_IO_PORTS;
|
|
static int irq_01bb_by_pos[] = MCA_01BB_IRQS;
|
|
char *name;
|
|
int clock;
|
|
|
|
pos[0] = mca_device_read_stored_pos(mca_dev, 2);
|
|
pos[1] = mca_device_read_stored_pos(mca_dev, 3);
|
|
pos[2] = mca_device_read_stored_pos(mca_dev, 4);
|
|
|
|
/*
|
|
* 01BB & 01BA port base by bits 7,6,5,4,3,2 in pos[2]
|
|
*
|
|
* 000000 <disabled> 001010 0x2800
|
|
* 000001 <invalid> 001011 0x2C00
|
|
* 000010 0x0800 001100 0x3000
|
|
* 000011 0x0C00 001101 0x3400
|
|
* 000100 0x1000 001110 0x3800
|
|
* 000101 0x1400 001111 0x3C00
|
|
* 000110 0x1800 010000 0x4000
|
|
* 000111 0x1C00 010001 0x4400
|
|
* 001000 0x2000 010010 0x4800
|
|
* 001001 0x2400 010011 0x4C00
|
|
* 010100 0x5000
|
|
*
|
|
* 00F4 port base by bits 3,2,1 in pos[0]
|
|
*
|
|
* 000 <disabled> 001 0x200
|
|
* 010 0x300 011 0x400
|
|
* 100 0x500 101 0x600
|
|
*
|
|
* 01BB & 01BA IRQ is specified in pos[0] bits 7 and 6:
|
|
*
|
|
* 00 3 10 11
|
|
* 01 5 11 14
|
|
*
|
|
* 00F4 IRQ specified by bits 6,5,4 in pos[0]
|
|
*
|
|
* 100 5 101 9
|
|
* 110 14
|
|
*/
|
|
|
|
if (id == 0x01bb || id == 0x01ba) {
|
|
base = io_01bb_by_pos[(pos[2] & 0xFC) >> 2];
|
|
irq_vector =
|
|
irq_01bb_by_pos[((pos[0] & 0xC0) >> 6)];
|
|
|
|
clock = 50;
|
|
if (id == 0x01bb)
|
|
name = "NCR 3360/3430 SCSI SubSystem";
|
|
else
|
|
name = "NCR Dual SIOP SCSI Host Adapter Board";
|
|
} else if ( id == 0x004f ) {
|
|
base = io_004f_by_pos[((pos[0] & 0x0E) >> 1)];
|
|
irq_vector =
|
|
irq_004f_by_pos[((pos[0] & 0x70) >> 4) - 4];
|
|
clock = 50;
|
|
name = "NCR 53c710 SCSI Host Adapter Board";
|
|
} else {
|
|
return -ENODEV;
|
|
}
|
|
mca_device_set_name(mca_dev, name);
|
|
mca_device_set_claim(mca_dev, 1);
|
|
base = mca_device_transform_ioport(mca_dev, base);
|
|
irq_vector = mca_device_transform_irq(mca_dev, irq_vector);
|
|
|
|
return sim710_probe_common(dev, base, irq_vector, clock,
|
|
0, id_array[slot]);
|
|
}
|
|
|
|
static struct mca_driver sim710_mca_driver = {
|
|
.id_table = sim710_mca_id_table,
|
|
.driver = {
|
|
.name = "sim710",
|
|
.bus = &mca_bus_type,
|
|
.probe = sim710_mca_probe,
|
|
.remove = __devexit_p(sim710_device_remove),
|
|
},
|
|
};
|
|
|
|
#endif /* CONFIG_MCA */
|
|
|
|
#ifdef CONFIG_EISA
|
|
static struct eisa_device_id sim710_eisa_ids[] = {
|
|
{ "CPQ4410" },
|
|
{ "CPQ4411" },
|
|
{ "HWP0C80" },
|
|
{ "" }
|
|
};
|
|
|
|
static __init int
|
|
sim710_eisa_probe(struct device *dev)
|
|
{
|
|
struct eisa_device *edev = to_eisa_device(dev);
|
|
unsigned long io_addr = edev->base_addr;
|
|
char eisa_cpq_irqs[] = { 11, 14, 15, 10, 9, 0 };
|
|
char eisa_hwp_irqs[] = { 3, 4, 5, 7, 12, 10, 11, 0};
|
|
char *eisa_irqs;
|
|
unsigned char irq_index;
|
|
unsigned char irq, differential = 0, scsi_id = 7;
|
|
|
|
if(strcmp(edev->id.sig, "HWP0C80") == 0) {
|
|
__u8 val;
|
|
eisa_irqs = eisa_hwp_irqs;
|
|
irq_index = (inb(io_addr + 0xc85) & 0x7) - 1;
|
|
|
|
val = inb(io_addr + 0x4);
|
|
scsi_id = ffs(val) - 1;
|
|
|
|
if(scsi_id > 7 || (val & ~(1<<scsi_id)) != 0) {
|
|
printk(KERN_ERR "sim710.c, EISA card %s has incorrect scsi_id, setting to 7\n", dev->bus_id);
|
|
scsi_id = 7;
|
|
}
|
|
} else {
|
|
eisa_irqs = eisa_cpq_irqs;
|
|
irq_index = inb(io_addr + 0xc88) & 0x07;
|
|
}
|
|
|
|
if(irq_index >= strlen(eisa_irqs)) {
|
|
printk("sim710.c: irq nasty\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
irq = eisa_irqs[irq_index];
|
|
|
|
return sim710_probe_common(dev, io_addr, irq, 50,
|
|
differential, scsi_id);
|
|
}
|
|
|
|
static struct eisa_driver sim710_eisa_driver = {
|
|
.id_table = sim710_eisa_ids,
|
|
.driver = {
|
|
.name = "sim710",
|
|
.probe = sim710_eisa_probe,
|
|
.remove = __devexit_p(sim710_device_remove),
|
|
},
|
|
};
|
|
#endif /* CONFIG_EISA */
|
|
|
|
static int __init sim710_init(void)
|
|
{
|
|
int err = -ENODEV;
|
|
|
|
#ifdef MODULE
|
|
if (sim710)
|
|
param_setup(sim710);
|
|
#endif
|
|
|
|
#ifdef CONFIG_MCA
|
|
err = mca_register_driver(&sim710_mca_driver);
|
|
#endif
|
|
|
|
#ifdef CONFIG_EISA
|
|
err = eisa_driver_register(&sim710_eisa_driver);
|
|
#endif
|
|
/* FIXME: what we'd really like to return here is -ENODEV if
|
|
* no devices have actually been found. Instead, the err
|
|
* above actually only reports problems with kobject_register,
|
|
* so for the moment return success */
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void __exit sim710_exit(void)
|
|
{
|
|
#ifdef CONFIG_MCA
|
|
if (MCA_bus)
|
|
mca_unregister_driver(&sim710_mca_driver);
|
|
#endif
|
|
|
|
#ifdef CONFIG_EISA
|
|
eisa_driver_unregister(&sim710_eisa_driver);
|
|
#endif
|
|
}
|
|
|
|
module_init(sim710_init);
|
|
module_exit(sim710_exit);
|