LXR linux/drivers/scsi/mvme16x

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