forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
136 lines
3.2 KiB
136 lines
3.2 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
|
|
/* |
|
* pata-isapnp.c - ISA PnP PATA controller driver. |
|
* Copyright 2005/2006 Red Hat Inc, all rights reserved. |
|
* |
|
* Based in part on ide-pnp.c by Andrey Panin <[email protected]> |
|
*/ |
|
|
|
#include <linux/kernel.h> |
|
#include <linux/module.h> |
|
#include <linux/isapnp.h> |
|
#include <linux/init.h> |
|
#include <linux/blkdev.h> |
|
#include <linux/delay.h> |
|
#include <scsi/scsi_host.h> |
|
#include <linux/ata.h> |
|
#include <linux/libata.h> |
|
|
|
#define DRV_NAME "pata_isapnp" |
|
#define DRV_VERSION "0.2.5" |
|
|
|
static struct scsi_host_template isapnp_sht = { |
|
ATA_PIO_SHT(DRV_NAME), |
|
}; |
|
|
|
static struct ata_port_operations isapnp_port_ops = { |
|
.inherits = &ata_sff_port_ops, |
|
.cable_detect = ata_cable_40wire, |
|
}; |
|
|
|
static struct ata_port_operations isapnp_noalt_port_ops = { |
|
.inherits = &ata_sff_port_ops, |
|
.cable_detect = ata_cable_40wire, |
|
/* No altstatus so we don't want to use the lost interrupt poll */ |
|
.lost_interrupt = ATA_OP_NULL, |
|
}; |
|
|
|
/** |
|
* isapnp_init_one - attach an isapnp interface |
|
* @idev: PnP device |
|
* @dev_id: matching detect line |
|
* |
|
* Register an ISA bus IDE interface. Such interfaces are PIO 0 and |
|
* non shared IRQ. |
|
*/ |
|
|
|
static int isapnp_init_one(struct pnp_dev *idev, const struct pnp_device_id *dev_id) |
|
{ |
|
struct ata_host *host; |
|
struct ata_port *ap; |
|
void __iomem *cmd_addr, *ctl_addr; |
|
int irq = 0; |
|
irq_handler_t handler = NULL; |
|
|
|
if (pnp_port_valid(idev, 0) == 0) |
|
return -ENODEV; |
|
|
|
if (pnp_irq_valid(idev, 0)) { |
|
irq = pnp_irq(idev, 0); |
|
handler = ata_sff_interrupt; |
|
} |
|
|
|
/* allocate host */ |
|
host = ata_host_alloc(&idev->dev, 1); |
|
if (!host) |
|
return -ENOMEM; |
|
|
|
/* acquire resources and fill host */ |
|
cmd_addr = devm_ioport_map(&idev->dev, pnp_port_start(idev, 0), 8); |
|
if (!cmd_addr) |
|
return -ENOMEM; |
|
|
|
ap = host->ports[0]; |
|
|
|
ap->ops = &isapnp_noalt_port_ops; |
|
ap->pio_mask = ATA_PIO0; |
|
ap->flags |= ATA_FLAG_SLAVE_POSS; |
|
|
|
ap->ioaddr.cmd_addr = cmd_addr; |
|
|
|
if (pnp_port_valid(idev, 1)) { |
|
ctl_addr = devm_ioport_map(&idev->dev, |
|
pnp_port_start(idev, 1), 1); |
|
ap->ioaddr.altstatus_addr = ctl_addr; |
|
ap->ioaddr.ctl_addr = ctl_addr; |
|
ap->ops = &isapnp_port_ops; |
|
} |
|
|
|
ata_sff_std_ports(&ap->ioaddr); |
|
|
|
ata_port_desc(ap, "cmd 0x%llx ctl 0x%llx", |
|
(unsigned long long)pnp_port_start(idev, 0), |
|
(unsigned long long)pnp_port_start(idev, 1)); |
|
|
|
/* activate */ |
|
return ata_host_activate(host, irq, handler, 0, |
|
&isapnp_sht); |
|
} |
|
|
|
/** |
|
* isapnp_remove_one - unplug an isapnp interface |
|
* @idev: PnP device |
|
* |
|
* Remove a previously configured PnP ATA port. Called only on module |
|
* unload events as the core does not currently deal with ISAPnP docking. |
|
*/ |
|
|
|
static void isapnp_remove_one(struct pnp_dev *idev) |
|
{ |
|
struct device *dev = &idev->dev; |
|
struct ata_host *host = dev_get_drvdata(dev); |
|
|
|
ata_host_detach(host); |
|
} |
|
|
|
static struct pnp_device_id isapnp_devices[] = { |
|
/* Generic ESDI/IDE/ATA compatible hard disk controller */ |
|
{.id = "PNP0600", .driver_data = 0}, |
|
{.id = ""} |
|
}; |
|
|
|
MODULE_DEVICE_TABLE(pnp, isapnp_devices); |
|
|
|
static struct pnp_driver isapnp_driver = { |
|
.name = DRV_NAME, |
|
.id_table = isapnp_devices, |
|
.probe = isapnp_init_one, |
|
.remove = isapnp_remove_one, |
|
}; |
|
|
|
module_pnp_driver(isapnp_driver); |
|
MODULE_AUTHOR("Alan Cox"); |
|
MODULE_DESCRIPTION("low-level driver for ISA PnP ATA"); |
|
MODULE_LICENSE("GPL"); |
|
MODULE_VERSION(DRV_VERSION);
|
|
|