[linux-2.6-block.git] / drivers / ide / ide-gd.c

#include <linux/module.h>
#include <linux/types.h>
#include <linux/string.h>
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/genhd.h>
#include <linux/mutex.h>
#include <linux/ide.h>
#include <linux/hdreg.h>
#include <linux/dmi.h>
#include <linux/slab.h>

#if !defined(CONFIG_DEBUG_BLOCK_EXT_DEVT)
#define IDE_DISK_MINORS		(1 << PARTN_BITS)
#else
#define IDE_DISK_MINORS		0
#endif

#include "ide-disk.h"
#include "ide-floppy.h"

#define IDE_GD_VERSION	"1.18"

/* module parameters */
static DEFINE_MUTEX(ide_gd_mutex);
static unsigned long debug_mask;
module_param(debug_mask, ulong, 0644);

static DEFINE_MUTEX(ide_disk_ref_mutex);

static void ide_disk_release(struct device *);

static struct ide_disk_obj *ide_disk_get(struct gendisk *disk)
{
	struct ide_disk_obj *idkp = NULL;

	mutex_lock(&ide_disk_ref_mutex);
	idkp = ide_drv_g(disk, ide_disk_obj);
	if (idkp) {
		if (ide_device_get(idkp->drive))
			idkp = NULL;
		else
			get_device(&idkp->dev);
	}
	mutex_unlock(&ide_disk_ref_mutex);
	return idkp;
}

static void ide_disk_put(struct ide_disk_obj *idkp)
{
	ide_drive_t *drive = idkp->drive;

	mutex_lock(&ide_disk_ref_mutex);
	put_device(&idkp->dev);
	ide_device_put(drive);
	mutex_unlock(&ide_disk_ref_mutex);
}

sector_t ide_gd_capacity(ide_drive_t *drive)
{
	return drive->capacity64;
}

static int ide_gd_probe(ide_drive_t *);

static void ide_gd_remove(ide_drive_t *drive)
{
	struct ide_disk_obj *idkp = drive->driver_data;
	struct gendisk *g = idkp->disk;

	ide_proc_unregister_driver(drive, idkp->driver);
	device_del(&idkp->dev);
	del_gendisk(g);
	drive->disk_ops->flush(drive);

	mutex_lock(&ide_disk_ref_mutex);
	put_device(&idkp->dev);
	mutex_unlock(&ide_disk_ref_mutex);
}

static void ide_disk_release(struct device *dev)
{
	struct ide_disk_obj *idkp = to_ide_drv(dev, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;
	struct gendisk *g = idkp->disk;

	drive->disk_ops = NULL;
	drive->driver_data = NULL;
	g->private_data = NULL;
	put_disk(g);
	kfree(idkp);
}

/*
 * On HPA drives the capacity needs to be
 * reinitialized on resume otherwise the disk
 * can not be used and a hard reset is required
 */
static void ide_gd_resume(ide_drive_t *drive)
{
	if (ata_id_hpa_enabled(drive->id))
		(void)drive->disk_ops->get_capacity(drive);
}

static const struct dmi_system_id ide_coldreboot_table[] = {
	{
		/* Acer TravelMate 66x cuts power during reboot */
		.ident   = "Acer TravelMate 660",
		.matches = {
			DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
			DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 660"),
		},
	},

	{ }	/* terminate list */
};

static void ide_gd_shutdown(ide_drive_t *drive)
{
#ifdef	CONFIG_ALPHA
	/* On Alpha, halt(8) doesn't actually turn the machine off,
	   it puts you into the sort of firmware monitor. Typically,
	   it's used to boot another kernel image, so it's not much
	   different from reboot(8). Therefore, we don't need to
	   spin down the disk in this case, especially since Alpha
	   firmware doesn't handle disks in standby mode properly.
	   On the other hand, it's reasonably safe to turn the power
	   off when the shutdown process reaches the firmware prompt,
	   as the firmware initialization takes rather long time -
	   at least 10 seconds, which should be sufficient for
	   the disk to expire its write cache. */
	if (system_state != SYSTEM_POWER_OFF) {
#else
	if (system_state == SYSTEM_RESTART &&
		!dmi_check_system(ide_coldreboot_table)) {
#endif
		drive->disk_ops->flush(drive);
		return;
	}

	printk(KERN_INFO "Shutdown: %s\n", drive->name);

	drive->gendev.bus->suspend(&drive->gendev, PMSG_SUSPEND);
}

#ifdef CONFIG_IDE_PROC_FS
static ide_proc_entry_t *ide_disk_proc_entries(ide_drive_t *drive)
{
	return (drive->media == ide_disk) ? ide_disk_proc : ide_floppy_proc;
}

static const struct ide_proc_devset *ide_disk_proc_devsets(ide_drive_t *drive)
{
	return (drive->media == ide_disk) ? ide_disk_settings
					  : ide_floppy_settings;
}
#endif

static ide_startstop_t ide_gd_do_request(ide_drive_t *drive,
					 struct request *rq, sector_t sector)
{
	return drive->disk_ops->do_request(drive, rq, sector);
}

static struct ide_driver ide_gd_driver = {
	.gen_driver = {
		.owner		= THIS_MODULE,
		.name		= "ide-gd",
		.bus		= &ide_bus_type,
	},
	.probe			= ide_gd_probe,
	.remove			= ide_gd_remove,
	.resume			= ide_gd_resume,
	.shutdown		= ide_gd_shutdown,
	.version		= IDE_GD_VERSION,
	.do_request		= ide_gd_do_request,
#ifdef CONFIG_IDE_PROC_FS
	.proc_entries		= ide_disk_proc_entries,
	.proc_devsets		= ide_disk_proc_devsets,
#endif
};

static int ide_gd_open(struct block_device *bdev, fmode_t mode)
{
	struct gendisk *disk = bdev->bd_disk;
	struct ide_disk_obj *idkp;
	ide_drive_t *drive;
	int ret = 0;

	idkp = ide_disk_get(disk);
	if (idkp == NULL)
		return -ENXIO;

	drive = idkp->drive;

	ide_debug_log(IDE_DBG_FUNC, "enter");

	idkp->openers++;

	if ((drive->dev_flags & IDE_DFLAG_REMOVABLE) && idkp->openers == 1) {
		drive->dev_flags &= ~IDE_DFLAG_FORMAT_IN_PROGRESS;
		/* Just in case */

		ret = drive->disk_ops->init_media(drive, disk);

		/*
		 * Allow O_NDELAY to open a drive without a disk, or with an
		 * unreadable disk, so that we can get the format capacity
		 * of the drive or begin the format - Sam
		 */
		if (ret && (mode & FMODE_NDELAY) == 0) {
			ret = -EIO;
			goto out_put_idkp;
		}

		if ((drive->dev_flags & IDE_DFLAG_WP) && (mode & FMODE_WRITE)) {
			ret = -EROFS;
			goto out_put_idkp;
		}

		/*
		 * Ignore the return code from door_lock,
		 * since the open() has already succeeded,
		 * and the door_lock is irrelevant at this point.
		 */
		drive->disk_ops->set_doorlock(drive, disk, 1);
		drive->dev_flags |= IDE_DFLAG_MEDIA_CHANGED;
		check_disk_change(bdev);
	} else if (drive->dev_flags & IDE_DFLAG_FORMAT_IN_PROGRESS) {
		ret = -EBUSY;
		goto out_put_idkp;
	}
	return 0;

out_put_idkp:
	idkp->openers--;
	ide_disk_put(idkp);
	return ret;
}

static int ide_gd_unlocked_open(struct block_device *bdev, fmode_t mode)
{
	int ret;

	mutex_lock(&ide_gd_mutex);
	ret = ide_gd_open(bdev, mode);
	mutex_unlock(&ide_gd_mutex);

	return ret;
}


static void ide_gd_release(struct gendisk *disk, fmode_t mode)
{
	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;

	ide_debug_log(IDE_DBG_FUNC, "enter");

	mutex_lock(&ide_gd_mutex);
	if (idkp->openers == 1)
		drive->disk_ops->flush(drive);

	if ((drive->dev_flags & IDE_DFLAG_REMOVABLE) && idkp->openers == 1) {
		drive->disk_ops->set_doorlock(drive, disk, 0);
		drive->dev_flags &= ~IDE_DFLAG_FORMAT_IN_PROGRESS;
	}

	idkp->openers--;

	ide_disk_put(idkp);
	mutex_unlock(&ide_gd_mutex);
}

static int ide_gd_getgeo(struct block_device *bdev, struct hd_geometry *geo)
{
	struct ide_disk_obj *idkp = ide_drv_g(bdev->bd_disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;

	geo->heads = drive->bios_head;
	geo->sectors = drive->bios_sect;
	geo->cylinders = (u16)drive->bios_cyl; /* truncate */
	return 0;
}

static unsigned int ide_gd_check_events(struct gendisk *disk,
					unsigned int clearing)
{
	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;
	bool ret;

	/* do not scan partitions twice if this is a removable device */
	if (drive->dev_flags & IDE_DFLAG_ATTACH) {
		drive->dev_flags &= ~IDE_DFLAG_ATTACH;
		return 0;
	}

	/*
	 * The following is used to force revalidation on the first open on
	 * removeable devices, and never gets reported to userland as
	 * genhd->events is 0.  This is intended as removeable ide disk
	 * can't really detect MEDIA_CHANGE events.
	 */
	ret = drive->dev_flags & IDE_DFLAG_MEDIA_CHANGED;
	drive->dev_flags &= ~IDE_DFLAG_MEDIA_CHANGED;

	return ret ? DISK_EVENT_MEDIA_CHANGE : 0;
}

static void ide_gd_unlock_native_capacity(struct gendisk *disk)
{
	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;
	const struct ide_disk_ops *disk_ops = drive->disk_ops;

	if (disk_ops->unlock_native_capacity)
		disk_ops->unlock_native_capacity(drive);
}

static int ide_gd_revalidate_disk(struct gendisk *disk)
{
	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;

	if (ide_gd_check_events(disk, 0))
		drive->disk_ops->get_capacity(drive);

	set_capacity(disk, ide_gd_capacity(drive));
	return 0;
}

static int ide_gd_ioctl(struct block_device *bdev, fmode_t mode,
			     unsigned int cmd, unsigned long arg)
{
	struct ide_disk_obj *idkp = ide_drv_g(bdev->bd_disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;

	return drive->disk_ops->ioctl(drive, bdev, mode, cmd, arg);
}

static const struct block_device_operations ide_gd_ops = {
	.owner			= THIS_MODULE,
	.open			= ide_gd_unlocked_open,
	.release		= ide_gd_release,
	.ioctl			= ide_gd_ioctl,
	.getgeo			= ide_gd_getgeo,
	.check_events		= ide_gd_check_events,
	.unlock_native_capacity	= ide_gd_unlock_native_capacity,
	.revalidate_disk	= ide_gd_revalidate_disk
};

static int ide_gd_probe(ide_drive_t *drive)
{
	const struct ide_disk_ops *disk_ops = NULL;
	struct ide_disk_obj *idkp;
	struct gendisk *g;

	/* strstr("foo", "") is non-NULL */
	if (!strstr("ide-gd", drive->driver_req))
		goto failed;

#ifdef CONFIG_IDE_GD_ATA
	if (drive->media == ide_disk)
		disk_ops = &ide_ata_disk_ops;
#endif
#ifdef CONFIG_IDE_GD_ATAPI
	if (drive->media == ide_floppy)
		disk_ops = &ide_atapi_disk_ops;
#endif
	if (disk_ops == NULL)
		goto failed;

	if (disk_ops->check(drive, DRV_NAME) == 0) {
		printk(KERN_ERR PFX "%s: not supported by this driver\n",
			drive->name);
		goto failed;
	}

	idkp = kzalloc(sizeof(*idkp), GFP_KERNEL);
	if (!idkp) {
		printk(KERN_ERR PFX "%s: can't allocate a disk structure\n",
			drive->name);
		goto failed;
	}

	g = alloc_disk_node(IDE_DISK_MINORS, hwif_to_node(drive->hwif));
	if (!g)
		goto out_free_idkp;

	ide_init_disk(g, drive);

	idkp->dev.parent = &drive->gendev;
	idkp->dev.release = ide_disk_release;
	dev_set_name(&idkp->dev, "%s", dev_name(&drive->gendev));

	if (device_register(&idkp->dev))
		goto out_free_disk;

	idkp->drive = drive;
	idkp->driver = &ide_gd_driver;
	idkp->disk = g;

	g->private_data = &idkp->driver;

	drive->driver_data = idkp;
	drive->debug_mask = debug_mask;
	drive->disk_ops = disk_ops;

	disk_ops->setup(drive);

	set_capacity(g, ide_gd_capacity(drive));

	g->minors = IDE_DISK_MINORS;
	g->driverfs_dev = &drive->gendev;
	g->flags |= GENHD_FL_EXT_DEVT;
	if (drive->dev_flags & IDE_DFLAG_REMOVABLE)
		g->flags = GENHD_FL_REMOVABLE;
	g->fops = &ide_gd_ops;
	add_disk(g);
	return 0;

out_free_disk:
	put_disk(g);
out_free_idkp:
	kfree(idkp);
failed:
	return -ENODEV;
}

static int __init ide_gd_init(void)
{
	printk(KERN_INFO DRV_NAME " driver " IDE_GD_VERSION "\n");
	return driver_register(&ide_gd_driver.gen_driver);
}

static void __exit ide_gd_exit(void)
{
	driver_unregister(&ide_gd_driver.gen_driver);
}

MODULE_ALIAS("ide:*m-disk*");
MODULE_ALIAS("ide-disk");
MODULE_ALIAS("ide:*m-floppy*");
MODULE_ALIAS("ide-floppy");
module_init(ide_gd_init);
module_exit(ide_gd_exit);
MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("generic ATA/ATAPI disk driver");
Commit	Line	Data
5fef0e5c BZ	1	#include <linux/module.h>
	2	#include <linux/types.h>
	3	#include <linux/string.h>
	4	#include <linux/kernel.h>
	5	#include <linux/errno.h>
	6	#include <linux/genhd.h>
	7	#include <linux/mutex.h>
	8	#include <linux/ide.h>
	9	#include <linux/hdreg.h>
b0aedb04	10	#include <linux/dmi.h>
5a0e3ad6	11	#include <linux/slab.h>
5fef0e5c BZ	12
	13	#if !defined(CONFIG_DEBUG_BLOCK_EXT_DEVT)
	14	#define IDE_DISK_MINORS (1 << PARTN_BITS)
	15	#else
	16	#define IDE_DISK_MINORS 0
	17	#endif
	18
	19	#include "ide-disk.h"
806f80a6	20	#include "ide-floppy.h"
5fef0e5c BZ	21
	22	#define IDE_GD_VERSION "1.18"
	23
806f80a6	24	/* module parameters */
2a48fc0a	25	static DEFINE_MUTEX(ide_gd_mutex);
806f80a6 BZ	26	static unsigned long debug_mask;
	27	module_param(debug_mask, ulong, 0644);
	28
5fef0e5c BZ	29	static DEFINE_MUTEX(ide_disk_ref_mutex);
5fef0e5c BZ	30
8fed4368	31	static void ide_disk_release(struct device *);
5fef0e5c BZ	32
	33	static struct ide_disk_obj ide_disk_get(struct gendisk disk)
	34	{
	35	struct ide_disk_obj *idkp = NULL;
	36
	37	mutex_lock(&ide_disk_ref_mutex);
	38	idkp = ide_drv_g(disk, ide_disk_obj);
	39	if (idkp) {
	40	if (ide_device_get(idkp->drive))
	41	idkp = NULL;
	42	else
8fed4368	43	get_device(&idkp->dev);
5fef0e5c BZ	44	}
	45	mutex_unlock(&ide_disk_ref_mutex);
	46	return idkp;
	47	}
	48
	49	static void ide_disk_put(struct ide_disk_obj *idkp)
	50	{
	51	ide_drive_t *drive = idkp->drive;
	52
	53	mutex_lock(&ide_disk_ref_mutex);
8fed4368	54	put_device(&idkp->dev);
5fef0e5c BZ	55	ide_device_put(drive);
	56	mutex_unlock(&ide_disk_ref_mutex);
	57	}
	58
	59	sector_t ide_gd_capacity(ide_drive_t *drive)
	60	{
	61	return drive->capacity64;
	62	}
	63
	64	static int ide_gd_probe(ide_drive_t *);
	65
	66	static void ide_gd_remove(ide_drive_t *drive)
	67	{
	68	struct ide_disk_obj *idkp = drive->driver_data;
	69	struct gendisk *g = idkp->disk;
	70
	71	ide_proc_unregister_driver(drive, idkp->driver);
8fed4368	72	device_del(&idkp->dev);
5fef0e5c	73	del_gendisk(g);
806f80a6	74	drive->disk_ops->flush(drive);
5fef0e5c	75
8fed4368 BZ	76	mutex_lock(&ide_disk_ref_mutex);
	77	put_device(&idkp->dev);
	78	mutex_unlock(&ide_disk_ref_mutex);
5fef0e5c BZ	79	}
5fef0e5c BZ	80
8fed4368	81	static void ide_disk_release(struct device *dev)
5fef0e5c	82	{
8fed4368	83	struct ide_disk_obj *idkp = to_ide_drv(dev, ide_disk_obj);
5fef0e5c BZ	84	ide_drive_t *drive = idkp->drive;
	85	struct gendisk *g = idkp->disk;
	86
806f80a6	87	drive->disk_ops = NULL;
5fef0e5c BZ	88	drive->driver_data = NULL;
	89	g->private_data = NULL;
	90	put_disk(g);
	91	kfree(idkp);
	92	}
	93
	94	/*
	95	* On HPA drives the capacity needs to be
421f91d2	96	* reinitialized on resume otherwise the disk
5fef0e5c BZ	97	* can not be used and a hard reset is required
	98	*/
	99	static void ide_gd_resume(ide_drive_t *drive)
	100	{
	101	if (ata_id_hpa_enabled(drive->id))
806f80a6	102	(void)drive->disk_ops->get_capacity(drive);
5fef0e5c BZ	103	}
5fef0e5c BZ	104
b0aedb04 BP	105	static const struct dmi_system_id ide_coldreboot_table[] = {
	106	{
	107	/* Acer TravelMate 66x cuts power during reboot */
	108	.ident = "Acer TravelMate 660",
	109	.matches = {
	110	DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
	111	DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 660"),
	112	},
	113	},
	114
	115	{ } /* terminate list */
	116	};
	117
5fef0e5c BZ	118	static void ide_gd_shutdown(ide_drive_t *drive)
	119	{
	120	#ifdef CONFIG_ALPHA
	121	/* On Alpha, halt(8) doesn't actually turn the machine off,
	122	it puts you into the sort of firmware monitor. Typically,
	123	it's used to boot another kernel image, so it's not much
	124	different from reboot(8). Therefore, we don't need to
	125	spin down the disk in this case, especially since Alpha
	126	firmware doesn't handle disks in standby mode properly.
	127	On the other hand, it's reasonably safe to turn the power
	128	off when the shutdown process reaches the firmware prompt,
	129	as the firmware initialization takes rather long time -
	130	at least 10 seconds, which should be sufficient for
	131	the disk to expire its write cache. */
	132	if (system_state != SYSTEM_POWER_OFF) {
	133	#else
b0aedb04 BP	134	if (system_state == SYSTEM_RESTART &&
b0aedb04 BP	135	!dmi_check_system(ide_coldreboot_table)) {
5fef0e5c	136	#endif
806f80a6	137	drive->disk_ops->flush(drive);
5fef0e5c BZ	138	return;
	139	}
	140
	141	printk(KERN_INFO "Shutdown: %s\n", drive->name);
	142
	143	drive->gendev.bus->suspend(&drive->gendev, PMSG_SUSPEND);
	144	}
	145
79cb3803 BZ	146	#ifdef CONFIG_IDE_PROC_FS
	147	static ide_proc_entry_t ide_disk_proc_entries(ide_drive_t drive)
	148	{
806f80a6	149	return (drive->media == ide_disk) ? ide_disk_proc : ide_floppy_proc;
79cb3803 BZ	150	}
	151
	152	static const struct ide_proc_devset ide_disk_proc_devsets(ide_drive_t drive)
	153	{
806f80a6 BZ	154	return (drive->media == ide_disk) ? ide_disk_settings
806f80a6 BZ	155	: ide_floppy_settings;
79cb3803 BZ	156	}
	157	#endif
	158
806f80a6 BZ	159	static ide_startstop_t ide_gd_do_request(ide_drive_t *drive,
	160	struct request *rq, sector_t sector)
	161	{
	162	return drive->disk_ops->do_request(drive, rq, sector);
	163	}
	164
7f3c868b	165	static struct ide_driver ide_gd_driver = {
5fef0e5c BZ	166	.gen_driver = {
5fef0e5c BZ	167	.owner = THIS_MODULE,
806f80a6	168	.name = "ide-gd",
5fef0e5c BZ	169	.bus = &ide_bus_type,
	170	},
	171	.probe = ide_gd_probe,
	172	.remove = ide_gd_remove,
	173	.resume = ide_gd_resume,
	174	.shutdown = ide_gd_shutdown,
	175	.version = IDE_GD_VERSION,
806f80a6	176	.do_request = ide_gd_do_request,
5fef0e5c	177	#ifdef CONFIG_IDE_PROC_FS
79cb3803 BZ	178	.proc_entries = ide_disk_proc_entries,
79cb3803 BZ	179	.proc_devsets = ide_disk_proc_devsets,
5fef0e5c BZ	180	#endif
	181	};
	182
b2f21e05	183	static int ide_gd_open(struct block_device *bdev, fmode_t mode)
5fef0e5c	184	{
b2f21e05	185	struct gendisk *disk = bdev->bd_disk;
5fef0e5c BZ	186	struct ide_disk_obj *idkp;
5fef0e5c BZ	187	ide_drive_t *drive;
806f80a6	188	int ret = 0;
5fef0e5c BZ	189
	190	idkp = ide_disk_get(disk);
	191	if (idkp == NULL)
	192	return -ENXIO;
	193
	194	drive = idkp->drive;
	195
088b1b88	196	ide_debug_log(IDE_DBG_FUNC, "enter");
806f80a6	197
5fef0e5c BZ	198	idkp->openers++;
	199
	200	if ((drive->dev_flags & IDE_DFLAG_REMOVABLE) && idkp->openers == 1) {
806f80a6 BZ	201	drive->dev_flags &= ~IDE_DFLAG_FORMAT_IN_PROGRESS;
	202	/* Just in case */
	203
	204	ret = drive->disk_ops->init_media(drive, disk);
	205
	206	/*
	207	* Allow O_NDELAY to open a drive without a disk, or with an
	208	* unreadable disk, so that we can get the format capacity
	209	* of the drive or begin the format - Sam
	210	*/
b2f21e05	211	if (ret && (mode & FMODE_NDELAY) == 0) {
806f80a6 BZ	212	ret = -EIO;
	213	goto out_put_idkp;
	214	}
	215
b2f21e05	216	if ((drive->dev_flags & IDE_DFLAG_WP) && (mode & FMODE_WRITE)) {
806f80a6 BZ	217	ret = -EROFS;
	218	goto out_put_idkp;
	219	}
	220
5fef0e5c BZ	221	/*
	222	* Ignore the return code from door_lock,
	223	* since the open() has already succeeded,
	224	* and the door_lock is irrelevant at this point.
	225	*/
806f80a6	226	drive->disk_ops->set_doorlock(drive, disk, 1);
cedd120c	227	drive->dev_flags \|= IDE_DFLAG_MEDIA_CHANGED;
b2f21e05	228	check_disk_change(bdev);
806f80a6 BZ	229	} else if (drive->dev_flags & IDE_DFLAG_FORMAT_IN_PROGRESS) {
	230	ret = -EBUSY;
	231	goto out_put_idkp;
5fef0e5c BZ	232	}
5fef0e5c BZ	233	return 0;
806f80a6 BZ	234
	235	out_put_idkp:
	236	idkp->openers--;
	237	ide_disk_put(idkp);
	238	return ret;
5fef0e5c BZ	239	}
5fef0e5c BZ	240
6e9624b8 AB	241	static int ide_gd_unlocked_open(struct block_device *bdev, fmode_t mode)
	242	{
	243	int ret;
	244
2a48fc0a	245	mutex_lock(&ide_gd_mutex);
6e9624b8	246	ret = ide_gd_open(bdev, mode);
2a48fc0a	247	mutex_unlock(&ide_gd_mutex);
6e9624b8 AB	248
	249	return ret;
	250	}
	251
	252
db2a144b	253	static void ide_gd_release(struct gendisk *disk, fmode_t mode)
5fef0e5c	254	{
5fef0e5c BZ	255	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	256	ide_drive_t *drive = idkp->drive;
	257
088b1b88	258	ide_debug_log(IDE_DBG_FUNC, "enter");
806f80a6	259
2a48fc0a	260	mutex_lock(&ide_gd_mutex);
5fef0e5c	261	if (idkp->openers == 1)
806f80a6	262	drive->disk_ops->flush(drive);
5fef0e5c	263
806f80a6 BZ	264	if ((drive->dev_flags & IDE_DFLAG_REMOVABLE) && idkp->openers == 1) {
	265	drive->disk_ops->set_doorlock(drive, disk, 0);
	266	drive->dev_flags &= ~IDE_DFLAG_FORMAT_IN_PROGRESS;
	267	}
5fef0e5c BZ	268
	269	idkp->openers--;
	270
	271	ide_disk_put(idkp);
2a48fc0a	272	mutex_unlock(&ide_gd_mutex);
5fef0e5c BZ	273	}
	274
	275	static int ide_gd_getgeo(struct block_device bdev, struct hd_geometry geo)
	276	{
	277	struct ide_disk_obj *idkp = ide_drv_g(bdev->bd_disk, ide_disk_obj);
	278	ide_drive_t *drive = idkp->drive;
	279
	280	geo->heads = drive->bios_head;
	281	geo->sectors = drive->bios_sect;
	282	geo->cylinders = (u16)drive->bios_cyl; /* truncate */
	283	return 0;
	284	}
	285
5b03a1b1 TH	286	static unsigned int ide_gd_check_events(struct gendisk *disk,
5b03a1b1 TH	287	unsigned int clearing)
5fef0e5c BZ	288	{
	289	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	290	ide_drive_t *drive = idkp->drive;
5b03a1b1	291	bool ret;
5fef0e5c BZ	292
	293	/* do not scan partitions twice if this is a removable device */
	294	if (drive->dev_flags & IDE_DFLAG_ATTACH) {
	295	drive->dev_flags &= ~IDE_DFLAG_ATTACH;
	296	return 0;
	297	}
	298
7eec77a1 TH	299	/*
	300	* The following is used to force revalidation on the first open on
	301	* removeable devices, and never gets reported to userland as
	302	* genhd->events is 0. This is intended as removeable ide disk
	303	* can't really detect MEDIA_CHANGE events.
	304	*/
5b03a1b1	305	ret = drive->dev_flags & IDE_DFLAG_MEDIA_CHANGED;
cedd120c BZ	306	drive->dev_flags &= ~IDE_DFLAG_MEDIA_CHANGED;
cedd120c BZ	307
5b03a1b1	308	return ret ? DISK_EVENT_MEDIA_CHANGE : 0;
5fef0e5c BZ	309	}
5fef0e5c BZ	310
c3e33e04	311	static void ide_gd_unlock_native_capacity(struct gendisk *disk)
e957b60d BZ	312	{
	313	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	314	ide_drive_t *drive = idkp->drive;
	315	const struct ide_disk_ops *disk_ops = drive->disk_ops;
	316
c3e33e04 TH	317	if (disk_ops->unlock_native_capacity)
c3e33e04 TH	318	disk_ops->unlock_native_capacity(drive);
e957b60d BZ	319	}
e957b60d BZ	320
5fef0e5c BZ	321	static int ide_gd_revalidate_disk(struct gendisk *disk)
	322	{
	323	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
52ebb438 BP	324	ide_drive_t *drive = idkp->drive;
52ebb438 BP	325
5b03a1b1	326	if (ide_gd_check_events(disk, 0))
52ebb438 BP	327	drive->disk_ops->get_capacity(drive);
	328
	329	set_capacity(disk, ide_gd_capacity(drive));
5fef0e5c BZ	330	return 0;
	331	}
	332
b2f21e05	333	static int ide_gd_ioctl(struct block_device *bdev, fmode_t mode,
806f80a6 BZ	334	unsigned int cmd, unsigned long arg)
806f80a6 BZ	335	{
806f80a6 BZ	336	struct ide_disk_obj *idkp = ide_drv_g(bdev->bd_disk, ide_disk_obj);
	337	ide_drive_t *drive = idkp->drive;
	338
b2f21e05	339	return drive->disk_ops->ioctl(drive, bdev, mode, cmd, arg);
806f80a6 BZ	340	}
806f80a6 BZ	341
83d5cde4	342	static const struct block_device_operations ide_gd_ops = {
5fef0e5c	343	.owner = THIS_MODULE,
6e9624b8	344	.open = ide_gd_unlocked_open,
b2f21e05	345	.release = ide_gd_release,
8a6cfeb6	346	.ioctl = ide_gd_ioctl,
5fef0e5c	347	.getgeo = ide_gd_getgeo,
5b03a1b1	348	.check_events = ide_gd_check_events,
c3e33e04	349	.unlock_native_capacity = ide_gd_unlock_native_capacity,
5fef0e5c BZ	350	.revalidate_disk = ide_gd_revalidate_disk
	351	};
	352
	353	static int ide_gd_probe(ide_drive_t *drive)
	354	{
806f80a6	355	const struct ide_disk_ops *disk_ops = NULL;
5fef0e5c BZ	356	struct ide_disk_obj *idkp;
	357	struct gendisk *g;
	358
	359	/* strstr("foo", "") is non-NULL */
806f80a6 BZ	360	if (!strstr("ide-gd", drive->driver_req))
	361	goto failed;
	362
	363	#ifdef CONFIG_IDE_GD_ATA
	364	if (drive->media == ide_disk)
	365	disk_ops = &ide_ata_disk_ops;
	366	#endif
	367	#ifdef CONFIG_IDE_GD_ATAPI
	368	if (drive->media == ide_floppy)
	369	disk_ops = &ide_atapi_disk_ops;
	370	#endif
	371	if (disk_ops == NULL)
5fef0e5c BZ	372	goto failed;
5fef0e5c BZ	373
806f80a6 BZ	374	if (disk_ops->check(drive, DRV_NAME) == 0) {
	375	printk(KERN_ERR PFX "%s: not supported by this driver\n",
	376	drive->name);
5fef0e5c	377	goto failed;
806f80a6	378	}
5fef0e5c BZ	379
5fef0e5c BZ	380	idkp = kzalloc(sizeof(*idkp), GFP_KERNEL);
806f80a6 BZ	381	if (!idkp) {
	382	printk(KERN_ERR PFX "%s: can't allocate a disk structure\n",
	383	drive->name);
5fef0e5c	384	goto failed;
806f80a6	385	}
5fef0e5c BZ	386
	387	g = alloc_disk_node(IDE_DISK_MINORS, hwif_to_node(drive->hwif));
	388	if (!g)
	389	goto out_free_idkp;
	390
	391	ide_init_disk(g, drive);
	392
8fed4368 BZ	393	idkp->dev.parent = &drive->gendev;
8fed4368 BZ	394	idkp->dev.release = ide_disk_release;
02aa2a37	395	dev_set_name(&idkp->dev, "%s", dev_name(&drive->gendev));
8fed4368 BZ	396
	397	if (device_register(&idkp->dev))
	398	goto out_free_disk;
5fef0e5c BZ	399
	400	idkp->drive = drive;
	401	idkp->driver = &ide_gd_driver;
	402	idkp->disk = g;
	403
	404	g->private_data = &idkp->driver;
	405
	406	drive->driver_data = idkp;
806f80a6 BZ	407	drive->debug_mask = debug_mask;
806f80a6 BZ	408	drive->disk_ops = disk_ops;
5fef0e5c	409
806f80a6	410	disk_ops->setup(drive);
5fef0e5c BZ	411
	412	set_capacity(g, ide_gd_capacity(drive));
	413
	414	g->minors = IDE_DISK_MINORS;
	415	g->driverfs_dev = &drive->gendev;
	416	g->flags \|= GENHD_FL_EXT_DEVT;
	417	if (drive->dev_flags & IDE_DFLAG_REMOVABLE)
	418	g->flags = GENHD_FL_REMOVABLE;
	419	g->fops = &ide_gd_ops;
	420	add_disk(g);
	421	return 0;
	422
8fed4368 BZ	423	out_free_disk:
8fed4368 BZ	424	put_disk(g);
5fef0e5c BZ	425	out_free_idkp:
	426	kfree(idkp);
	427	failed:
	428	return -ENODEV;
	429	}
	430
	431	static int __init ide_gd_init(void)
	432	{
806f80a6	433	printk(KERN_INFO DRV_NAME " driver " IDE_GD_VERSION "\n");
5fef0e5c BZ	434	return driver_register(&ide_gd_driver.gen_driver);
	435	}
	436
	437	static void __exit ide_gd_exit(void)
	438	{
	439	driver_unregister(&ide_gd_driver.gen_driver);
	440	}
	441
	442	MODULE_ALIAS("ide:m-disk");
	443	MODULE_ALIAS("ide-disk");
806f80a6 BZ	444	MODULE_ALIAS("ide:m-floppy");
806f80a6 BZ	445	MODULE_ALIAS("ide-floppy");
5fef0e5c BZ	446	module_init(ide_gd_init);
	447	module_exit(ide_gd_exit);
	448	MODULE_LICENSE("GPL");
806f80a6	449	MODULE_DESCRIPTION("generic ATA/ATAPI disk driver");